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Preface 


Although industnal robots have been available for a number of vears. it is only 
since the early 1970s that research efforts into these sophisticated computer-con- 
trolled devices has begun to accelerate. The primary reasons for this are the advent 
and availability of the microprocessor and. in this country, the realization by in- 
dustry that robots must be used to meet the increased compeunon from foreign 
manufacturers. 

As a result of the industrial experience gained during a leave of absence. the 
principal author organized a senior/graduate course in robotics in the early 1980s. 
In assemblying the material for this course, the author found that very little was 
written on the specific subject of robotics. The reason for this is that. quite simply. 
robotics is not a single discipline. Rather, it is a highly multidisciplinary field that 
combines the areas of controls, computers (both the hardware and software as- 
pects), measurement technology (i.e. , sensors). pattern-recognition techniques and 
hardware (e.g., vision systems), and various aspects of mechanical engineenng. 
including statics, dynamics, kinematics, and mechanical design. A complete study 
of the subject should also involve some discussion of applications as well as the 
economics of robots and the sociological consequences of placing them in the 
workplace. Although it was certainly possible. at the time. to find maternal on 
many of these individual subjects. there was no single compilation of the topics 
that exsted which would permit a comprehensive course to be taught. Moreover. 
many of the papers wnitten were extremely low level and were often nothing more 
than glorified sales pitches. 

A number of years later, the situation has changed somewhat. with a relatively 
large number of books on the subject having come out in the interim. However. 
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these are, for the most part, descriptive, rather low-level texts that are aimed 
primarily at the two-year technology student and are therefore Inappropriate for 
engineering courses at any level. Of the few that are written at a higher level], 
some are rather sketchy and others are extremely detailed in only a few areas, 
Thus neither group is really applicable for comprehensive ‘core (or first-level) 
courses that seniors and/or graduate students would (and it is our feeling Should) 
want to take. 

It is quite apparent that robotics is a “hot” area and that there will be q 
definite need for a book that will permit an engineering core course (or courses) 
to be taught. Although there are still relatively few of these being offered at 
universities throughout the country, it seems to us that this is a result of there 
being no appropriate text available rather than there being a lack of interest ip 
teaching such acourse. Clearly, people will always want to teach their “specialties” 
(e.g., robotic controls, machine vision, etc.). It is our belief, however, that the 
more specialized courses that cover only a few topics in depth will have a greater 
impact on the student, and therefore, should be taught only after the relationship 
among the various disciplines that go into producing a working robot are clearly 
understood. Thus we feel, for example, that it is not appropriate to begin talking 
about optimal or adaptive control of a robot until one fully appreciates the ad- 
vantages and disadvantages of the type of control currently utilized and how the 
large swings in inertia (inevitably occurring as the manipulator moves in its work 
volume) affects the particular control strategy selected. Having said this, it is our 
judgment that a comprehensive text such as this one Should provide the reader 
with the “why” and “how to” aspects of robotics. Theorems and proofs are better 
left to follow-up specialty courses. This does not mean, however, that we utilize 
the anecdotal, often pseudotechnical approach that characterizes many of the cur- 
rently available texts and papers on the subject. Rather, we have utilized our 
extensive pedagogical and practical experience (with robots) to present to the reader 
many of the theoretical and practical concepts and ideas that are essential to 
understanding how a robot is designed and how it works. In doing this, it is our 
hope that the book will be extremely useful in the (engineering) academic sector 
and in the engineering workplace. With these ideas in mind, we have organized 
the book in the following manner: 


and various robot types, as well as the history, sociological, and economic impli- 
cations of these forms of automation. are discussed. In addition, current and 
future applications are given. The chapter goals are for the reader to be able to 
understand what an industrial robot is and What it is not, where it is applicable 
and where it is not, and finally, how such devices have evolved and how they well 
may Cause another industrial revolution to occur. 

Chapter 2 deals with the robot’s various ‘Omponent parts as well as how these 
devices are normally utilized in an automated system. At the conclusion of the 
chapter, it is expected that the reader will be able to identify the major syste™ 
components of a robot from a high-level. black-box point of view and will also be 
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able to understand the considerations that go into both the development of robotic 
systems specifications and the selection of system components. 

The next chapter presents the mechanical structure and discusses a variety 
of devices and components as they relate to robots. Various methods of converting 
rotary to linear motion are given from both the ideal and “‘real-world’’ points of 
view. It is the purpose of this chapter to provide an understanding of how certain 
mechanical components behave and how power Is transmitted from an actuator to 
aload. The reader will also learn about how many of these devices are used in 
a practical manner to produce a working robotic manipulator. 

The typical control structure of modern industrial robots is presented along 
with a fairly detailed discussion of various types of actuators and power amplifiers 
in Chapter 4. The reader will not only gain an understanding of how classical 
servo theory is applied to a robotic system to produce the desired robotic joint 
performance but will also learn about the various actuators and amplifiers available 
to the robot designer and which are preferred in a given application. Many prac- 
tical considerations that affect the proper operation of a robotic joint are included 
here. 

In the following chapter, the topic of nonvision-based robotic sensors is pre- 
sented in great detail. A large number of internal sensors are discussed, with 
special emphasis being given to the practical aspects of several, including the optical 
encoder. External sensors are also introduced, with the topics of proximity, weld- 
ing, and tactile sensors being discussed. The purpose of the chapter is to dem- 
onstrate clearly the role played by internal sensors in the control of individual 
robotic joints and also by external sensors in providing the robot with knowledge 
about its external environment. Also, the practical aspects of the presentation 
should assist the reader in understanding why certain sensors are to be preferred 
over others in a given application. 

Robotic (or machine) vision is discussed in Chapter 6. Various components 
of a vision system, as well as a number of image recognition techniques are pre- 
sented. The reader will be able to understand the similarities and dissimilarities 
of computer vision relative to other types of sensors and will appreciate the mag- 
nitude of the information-processing problem associated with using computer vision 
in a robotics application. The material in the chapter covers various vision sensors 
and systems, and discusses the capabilities (e.g., object detection versus inspection) 
of currently available, practical cost-effective vision technology. 

In Chapter 7 the architectural and hardware considerations related to the 
computers utilized in a robotic system are discussed. In addition, the role played 
by the computational elements in robotic applications is given and a summary of 
various robotic programming languages 1s presented. Various trade-offs that are 
required when using different computer architecture implementations for robotic 
systems are discussed. The reader will also learn about the practical considerations 
that go into the selection of a robot computer system, including the hardware, 
software, and task programming aspects. 

The important topics of coordinate transformations, along with how to obtain 
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the forward and inverse or back solutions, are presented in Chapter 8. Homo. 
s€neous transformations are introduced and how they are applied to a robot’s 
kinematic structure. Additional discussion involves the method used in a robot 
tO represent points in space and then how to utilize this information to Produce 
continuous-path, straight-line, and other types of coordinated motions. 

Chapter 9, the concluding chapter, brings together many of the important 
technological ideas presented in the preceding chapters. This is accomplished by 
designing various aspects of a robot required to perform a specific task (€.2., sortin 
eggs). From the material in this chapter it is expected that the reader will be able 
to take a set of given specifications and actually come up with a potential robot 
design. This should include the mechanical configuration, the control and com- 
puter structures, and the choice of actuators that will meet all of these Specs. 

Three appendices are included and should be of interest. The first is a 
compilation of existing commercial robots and their specifications/attributes. The 
second presents an orderly method of selecting a servomotor for a specific task. 
The last one discusses the digital control of a single robotic joint. 

As a text, the book is ideal for courses at the semior/graduate level in electrical 
engineering since it places a good deal of emphasis on subjects that are traditionally 
considered to be “electrical in nature.” However, many modern mechanical en- 
gineering curricula now require their students to take courses in controls (and 
systems), computers, and mathematics beyond the standard calculus, analytic ge- 
ometry, and differential equations sequence. For such departments, this book 
could be utilized in a robotics course with the assurance that much of the material 
would be within the abilities of their students. In fact, over the years that the 
authors have used the manuscript in a classroom environment, there have always 
been a number of mechanical engineers who successfully completed the course. 
The same js also true for the few computer science students, although, admittedly, 
they had a much more difficult time because of their lack of specific engineering 
knowledge. Although this book is definitely not an engineering technology text, 
since it assumes a fairly extensive analytical background, there are a small number 
of four-year technology programs (primarily, electrical) that could use some of the 
material in a robotics course at the senior level. 

As mentioned above, we have utilized the book in graduate courses that had 


both graduate and selected undergraduate students enrolled. There is more than 
enough material provided to cover a two-semester course. 


may wish to elaborate in some areas and gloss over others. 
depend on the backgrounds of the students and their needs. 
1 and 2 were covered in about three classes with the remainin 
devoted to (sometimes expanded versions of) 
fifth and seventh chapters. Also included was 
Appendices B and C. The second semester w 
and nonvision based), kinematics, and comput 
Also, Chapter 9 was discussed in great detail 
submit other designs for the same task. 


Clearly, the instructor 
This would obviously 
In our case, Chapters 
g part of the semester 
the third, fourth, and parts of the 
much of the material contained in 
as then devoted to sensors (vision 
er Systems and robotic languages: 
, with the students encouraged to 
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As a final word, it is our belief that the practical engineering approach that 
is utilized throughout the text will most certainly interest engineers who are working 
in the fields of controls and automation (e.g., those with backgrounds in electrical 
engineering, mechanical engineering, and computer science/engineering). In ad- 
dition, engineers working in industries that may be users of robots may find this 


book helpful in providing them with the background needed to select the correct 


type of robot (and the various options) to perform a specific task at their company’s 


plant. 
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Introduction 


1.0 OBJECTIVES 


As the reader will begin to appreciate, the study of robotics involves understanding 
a number of diverse subjects. For example, several engineering disciplines as well 
as those relating to physics, economics, and sociology must be mastered before 
one can truly acquire more than a nodding acquaintance with the field. This book 
is intended to be primarily an engineering text. However, before beginning a 
discussion of the technical aspects of robotics, it is necessary for the reader to 
become conversant with the language of the subject. Thus the overall objective 
of this chapter is to provide an overview of robotics, presenting the material in a 


descriptive, fairly nontechnical manner. 
Specifically, the topics that are covered are as follows: 


Historical perspective of robots 

Classification of robots 

Description of the major robot components 

Discussion of fixed versus flexible automation 

e Economic considerations used for the selection and justification of robots 
e Sociological consequences of automation/robots 

e Robot state-of-the-art survey 

e Current and future applications of industrial robots 
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When one first hears the word robot, the image that probably comes to mind jg 
that of a mobile biped that is both humanoid in structure and capable of independent 
actions (e.g., thinking). The George Lucas (Star Wars) creation C3-P0 is an 
example. Such devices are, unfortunately, still relegated to science fiction novels 
and motion pictures. The truth is that we simply do not, at this time, know how 
to create machines with this degree of intelligence and mobility. In fact, it is likely 
that unless there is a significant breakthrough in a number of areas such as artificial 
intelligence, computers, and power storage devices, most of the readers of this 
book will never see a robot that has anywhere near the capability of C3-P0. For 
this reason, in this book we choose to discuss industrial robots almost exclusively, 
As we will see in subsequent chapters, an industrial robot is a complex elec- 
tromechanical device that brings together a large number of disciplines in what could 
be termed a “polygamous relationship.” Despite the fact that this chapter will be 
a relatively descriptive, nontechnical introduction to the subject, a variety of im- 
portant questions must still be answered. For example, what types of mechanisms 
can be classified as industrial robots and what types cannot? From where did 
robots evolve, and what was the nature of the first devices produced? Also, since 
the robots about which we will be speaking will almost always be used in a manu- 
facturing environment, what are the economic justifications for utilizing such devices 
for a given task? Moreover, what applications are appropriately handled by robots 
both now and in the future? Finally, what type of robots are available in the 
marketplace today? Besides these important questions that we will attempt to 
answer later in this chapter, there are other considerations worthy of our attention. 
No study of robots would be complete without some discussion of their so- 
ciological consequences. It is clear that they will have a Significant impact on the 
manufacturing environment. But will workers in industries utilizing robots be 
displaced from their jobs, or will more jobs actually be created? How will these 
workers accept this new form of technology, and what can management and/or the 
government do to ease any problems that result from the introduction of this type 
of automation into the workplace? We will attempt to answer these extremely 
difficult questions, but the reader is warned not to expect easy answers: the authors 
unfortunately do not have magical solutions to the inevitable social problems. 
Regardless, we believe that if the United States is to reestablish itself as a world 
leader in manufacturing, robots will have to be utilized in ever-increasing numbers. 
We now trace the origin of the modern industrial robot and indicate how 
these devices have evolved in relationship to other technological developments. 


1.2 A HISTORICAL PERSPECTIVE OF ROBOTS 


The word robot — first used in 1921 by the Czech Playwright, novelist, and essay ist 
Karel Capek in his satirical drama entitled R.U.R. (Rossum’s Universal Robots) 
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[1]. It is derived from the Czech word robota. which literally means “forced 
laborer’ or “‘slave laborer.’ In his play. Capek pictured robots as machines that 
resembled people but worked twice as hard. These devices had arms and legs and 
no doubt were similar in many ways to C3-P0 in the 1977 film Star Wars. The 
industrial robot of today does not look the least bit human and therefore has little 
in common with Capek’s robots. 

Although Capek introduced the word “robot” to the world. the term “ro- 
botics”’ was coined by Isaac Asimov in his short story “Runaround., © first published 
in 1942. This work is also notable because the so-called “Three Rules (or Laws) 
of Robotics” are presented for the first time: 


1. A robot may not injure a human being, or, through inaction, allow one to come 
to harm. 


2. A robot must obey the orders given it by human beings except where such orders 
would conflict with the First Law. 


3. A robot must protect its own existence as long as such protection does not conflict 
with the First or Second Laws. [2] 


Asimov has stated that workers in the field of artificial intelligence indicated to 
him that these three laws should serve as a good guide as the field progresses. 

Before proceeding with the history of robots themselves, it is interesting to 
trace briefly the antecedents of these devices. Surprisingly (perhaps), the concept 
of a programmable machine dates back to eighteenth-century France and includes 
inventors such as Bouchon, Vacaunson, Basile, and Falcon. Possibly the best 
known of the group is Joseph Jacquard who developed the mechanical loom con- 
trolled by punched cards. Its mass production occurred around 1801. In the third 
decade of the nineteenth century, an American, Christopher Spencer, produced a 
programmable lathe called the automat that was capable of turning out screws, 
nuts, and gears. Its ‘‘programming,’’ and hence the pattern that was to be cut, 
was modified through the use of a set of interchangeable cam guides that were 
fitted on the end of a rotating drum. 

The problem of removing hot ingots from a furnace was solved by Seward 
Babbit in 1892. He developed and patented a rotary crane equipped with a mo- 
torized gripper. In 1938-1939, Willard Pollard invented a jointed mechanical arm 
that was utilized primarily in paint spraying. A similar device was developed by 
an employee of the DeVilbiss Co. (a current manufacturer of robots), Harold 
Roselund., 

A “relative” of the robotic manipulator, the teleoperator or telecheric, was 
developed during World War II to permit an operator to handle radioactive ma- 
terials at a safe distance. Just after the conclusion of this war, George Devol, the 
acknowledged “father of the robot,” developed a magnetic process controller that 
could be used as a general-purpose playback device for controlling machines. In 
the same year (1946), Eckert and Mauchly built the ENIAC, the first large-scale 
electronic computer, and at the Massachusetts Institute of Technology (MIT) a 
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general-purpose digital computer (Whirlwind) solved its first problem. One year 
later in 1947, a servoed* electric-powered teleoperator was introduced by Raymonq 
Goertz. It permitted the servo-controlled slave to follow the position command 
of the master (i.e., the operator). However, no force control was incorporated 
into the design until the following year. By permitting the load to back-drive the 
mechanical interface to the master, the sense of touch was restored to the operator 
In 1952 the first numerically controlled machine tool was developed at the MIT 
Servomechanism Laboratory. 

It is generally acknowledged that the “robot age” began in 1954 when Deyo] 
patented the first manipulator with a playback memory. This device was Capable 
of performing a controlled motion from one point to another (i.e., point-to-point 
motion). In addition, Devol also coined the phrase universal automation. (This 
was to be shortened later to.unimation.) Five years after this, the first commercia| 
robot was sold by the Planet Corporation. However, in 1960 Devol chose to sel] 
his original robot patents (approximately 40 in all) to Consolidated Diesel Cor- 
poration (Condec), which actually developed the Unimate robot at its newly formed 
subsidiary, Unimation, Inc.t The design of the Unimate combined the playback 
features of numerically controlled devices (e.g., milling machines) with the servo- 
controlled capabilities of the telecherics developed by Goertz. Two years later, 
in 1962, General Motors installed the first Unimate on one of its assembly lines in 
a die-casting application. 

By the mid 1960s, the new field of robotics sparked the formation of several 
centers of research into this area and the related topic of artificial intelligence (AI) 
at such institutions as MIT, Stanford University, Stanford Research Institute (SRI) 
International, and the University of Edinburgh in Scotland. In 1967, General 
Electric Corporation produced a four-legged vehicle (under a Department of De- 
fense contract) that required simultaneous control of the appendages by a human 
operator. This proved to be extremely difficult to achieve and the project was 
scrapped. A year later, SRI demonstrated an “‘intelligent” mobile robot that had 
some vision capability (using a TV camera), an optical range finder, and touch 
sensors (see Figure 1.2.1). The device also had the ability to understand and react 
to verbal commands in English. Because it moved in a highly irregular and jerky 
manner, it was given the name “Shakey.” 

One of the early innovators in the field of robotics, Victor Scheinman, while 
working at Stanford University in 1970 demonstrated a computer-controlled ma- 
nipulator that was powered by servomotors rather than by hydraulics. This six- 
axis device, shown in Figure 1.2.2 and variously referred to as the Scheinman or 
Stanford arm, was extremely sophisticated and technically complex and, in fact, is 


“A servomechanism (or more commonly, a servo) is a feedback control system in which the 
variable being controlled is a mechanical quantity such as velocity or position. 

tThis company became the largest robot manufacturer in the world (although it does not currently 
enjoy this position) and gained its independence from Condec in 1981. In the latter part of 1982, 
Unimation was acquired by the Westinghouse Corporation. 
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Figure 1.2.1. Shakey, a wheeled, nonautonomous robot that was developed in 1968 by 
Stanford Research Institute. (Courtesy of SRI International, Menlo Park, CA.) 
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ford arm. This 6-axis, electrically 


Figure 1.2.2. Jet Propulsion Laboratory—Stan 
ith JPL modifications. (Courtesy 


actuated robot utilizes the Scheinmann design w 
of Dr. A. K. Bejezy and Jet Propulsion Laboratories, Pasadena, CA.) 


still used today by anumber of research centers. Three years later, in 1973, Richard 
Hohn of the Cincinnati Milacron Corporation produced the first minicomputer- 
controlled commercial robot, the T°, which was a hydraulically actuated machine 
capable of lifting payloads of up to 100 Ib." Scheinman, recognizing the growth 
potential of industrial robots, founded his own company (Vicarm Inc.) and in 1974 
introduced the first servomotor-actuated, minicomputer-controlled manipulator. 
In the same year (1976) as the NASA Viking J and 2 landers used their manipulators 
to collect samples from the surface of Mars, Vicarm developed the first micro- 
processor-controlled robot under Navy contract. This year also saw a significant 
industrial development at the MIT Draper Laboratory, the invention of a compliant 
robot wrist (called a remote-centered compliance or RCC). Such a device per- 
mitted certain assembly operations to be performed by a rigid robot manipulator 
even when there was a significant misalignment between the robot tool and the 
part being worked on. 

A workable robotic vision system was developed by SRI in 1977 and resulted 
in a system commercialized by Machine Intelligence Corporation. In 1978, Uni- 
mation, working with a set of specifications provided by General Motors, developed 
the programmable universal machine for assembly (PUMA). This five- (or Six-) 
axis robot was servomotor driven and controlled by a number of microprocessors. 





*This is true for the T°-566. However, the more robust T3-586 will now carry up to 225 Ib. 
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Unimation (which by now had acquired Vicarm) used as their model an arm that 
Scheinman had developed while at MIT. 

In the mid-1970s, the importance of robots to the future of American industry 
was recognized when the National Bureau of Standards was directed to develop 
the Automated Manufacturing Research Facility (or AMRF) by the latter part of 
the 1980s. Well along in their work, a group at NBS under the leadership of 
James Albus has already made significant and practical contributions in the fields 
of robotic vision and controls. 1980 saw the establishment of the largest university- 
related robotics laboratory, at Carnegie—Mellon University. The Westinghouse 
Corporation was instrumental in getting this facility started by providing the initial 
funding. This year also saw the University of Rhode Island demonstrate a pro- 
totype robotic vision system that could handle the “bin picking” problem. Utilizing 
the techniques developed at URI, a robot was able to pick up randomly stacked 
rods. A modification of the system was marketed by Object Recognition Systems, 
Inc. and demonstrated in 1982. 

The area of mobile robots saw a substantial development when in 1983 a 
company called Odetics, Inc. introduced a unique experimental six-legged device 
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Figure 1.2.3. ODEX II, a second generation functionoid developed by Odetics, 
Inc. for use in nuclear power plants. Called “Robin,” this unique hexapod is 
capable of lifting loads up to 5.6 times its own weight and changing its geometry 
so as to facilitate moving through doorways or passageways. It is also equipped 
with a six-axis manipulator. (Courtesy of ODETICS, Inc., Anaheim,CA. Owned 
by Dept. of Energy and sponsored by the Savannah River Laboratory operated 
by DuPont.) 
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Figure 1.2.4. The RM3 Marine robot, an amphibious mobile device consisting of 
3 legs and one arm that can walk at speeds up to 150 meters/hour. The unit is 
used to clean the hulls of ships both above and below the water: (a) CAD-CAM 
generated line drawing; (b) CAD-CAM generated 3D solid version; (c) actual 
device. (Courtesy of P. Kroczinski, International Robotic Technologies Inc 

Marina del Rey, CA.) , ” 


that was designed by studying the gait of both human beings and certain insects. 
Originally called a functionoid, it demonstrated the ability to walk over obstacles 
and to lift loads up to 5.6 times its own weight while Stationary, and 2.3 times its 
weight while moving. Although the experimental unit was teleoperated the com- 
pany is currently working on producing a fully autonomous unit that ae be used 
in nuclear power plant installations. A second generation of such a device, called 
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(c) 


Figure 1.2.4. Continued. 


ODEX II, is equipped with an industrial type manipulator and gripper (see Figure 
1.2.3). The French shipbuilding company of Chantiers du Nord et de la Médi- 
terranée successfully tested a marine mobile robot in early 1984 (see Figure 1.2.4). 
Intended for cleaning the sides and bottoms of large ships, this remarkable device 
has already been used by Renault to paint the walls of a large gas tank. 
Although it would appear from this brief chronolog that the Japanese are 
‘“Johnny-come-latelies,” such is not the case. In fact, as early as 1968, Kawasaki 
Heavy Industries was granted a license from Unimation to manufacture their robots. 
The robot industry grew so rapidly that in 1971, the Japan Industrial Robot As- 
sociation (JIRA) was founded. It is interesting to note that despite all of the 
research activity in the United States, the Robotic Institute of America (RIA), 
now called the Robotic Industries Association, an organization primarily for man- 
ufacturers and users of robots, was begun only in 1975. An even more revealing 
Statistic is found in Joseph F. Engelberger’s excellent book entitled Robots In 
Practice [3]. At the time of its publication (September 1980), the author listed 
nine Japanese, nine European, and only four American companies manufacturing 
robots. Significant industrial effort in the United States has occurred since then. 
with the RIA (in its 1982 World Wide Robotics Survey and Directory) listing 
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approximately 28 American firms now involved in the manufacture of robots. [The 
same publication indicates that the numbers for both Japan and Europe have 
Increased also (to 16).] Nevertheless, this does demonstrate that the J apanese have 
been exceedingly active in the industrial application of robots for quite a long time, 

Now that the reader has been given a brief historical perspective, it is time 
to become more specific and to describe what is and what Is not a robot, and also 
what forms industrial robotic manipulators can take. 


1.3 CLASSIFICATION OF ROBOTS 


What exactly is a robot? As mentioned in the preceding section, it is not a C3- 
PO-like humanoid that has multiple appendages and is capable of decisions and 
actions based solely on moment-to-moment processing of information acquired 
through its external sensors. Webster defines a robot as 


An automatic apparatus or device that performs functions ordinarily ascribed to hu- 
mans Or operates with what appears to be almost human intelligence. [4] 


Although this definition may be adequate for a dictionary, it does not tell 
the entire story as far as an industrial device is concerned. Recognizing this, the 
RIA developed the following, more complete definition: 

A robot is a reprogrammable, multifunctional manipulator designed to move material, 

parts, tools, or specialized devices through variable programmed motions for the 

performance of a variety of tasks. 


Based on this definition, it is apparent that a robot must be able to operate au- 
tomatically, which implies that it must have some sort of programmable memory. 

In this section we follow the approach suggested by Engelberger (in his book) 
to classify industrial robotic manipulators in two different ways, One based on the 
mechanical configuration of the device and the other based on the general method 
used to control its individual members (i.e., the “joints” or “axes”’). Before doing 
this, however, we wish to consider several devices that are not truly robots but are 
often called by this name in the media. 


1.3.1 Robotic-Like Devices 


There are a number of devices that utilize certain facets of robot technology and 
are therefore often mistakenly called robots. In fact. Engelberger has referred to 
them as “near relations.” There are at least four such classes of mechanisms, two 
of which we have already briefly encountered in the preceding section. Each of 
these is now briefly described in turn. 
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1. Prostheses. These are often referred to as “robot arms” or “robot legs.” 
Even though they can make use of either hydraulic or servomotor actuators, utilize 
servo control, and have mechanical linkages, they do not have their own “brains 
and are not truly programmable. The impetus to produce an action (called the 
“command signal”) in such a device originates in the brain of the human being. 
It is then transmitted via nerves to the appropriate appendage, where electrodes 
sense the nerve impulses. These are processed electronically by a special-purpose 
computer (on board the prosthesis), which, in turn, controls the motion of the 
substitute limb (or hand). Although there are a number of serious research efforts 
into producing such an appendage, we are probably many years away from realizing 
the concepts described in the popular television series of the 1970s, ““The Six Million 
Dollar Man.” Among the many difficult problems that remain to be solved is the 
ability to reliably extract (from all the electrical activity produced by neighboring 
muscles) and process the low-level nerve impulse signals appropriate to controlling 


the missing limb. 


2. Exoskeletons. As shown in Figure 1.3.1, these are a collection of me- 
chanical linkages that are made to surround either human limbs or the entire human 
frame. They have the ability to amplify a human’s power. However, it is clear 


Figure 1.3.1. Artist’s conception of a 
General Electric Hardiman, an exoske- 
letal device developed in the 1970s. It 
allowed a human operator to lift loads 
up to 1500 Ibs. and utilized hydraulically 
actuated servos. 
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that they cannot act independently and, as such, are not robots. In fact, when an 
exoskeletal device is used, the operator must exercise extreme caution, due to the 
increased forces and/or speeds that are possible. An example of such a device jg 
the General Electric Hardiman, developed in the 1970s, which utilized hydraulically 
actuated servos. Loads of up to 1500 Ib could be lifted by a worker “Wearing” 
this piece of equipment (see Figure 1.3.1). 


3. Telecherics. As mentioned previously, these devices permit manipulation 
Or movement of materials and/or tools that are located many feet away from an 
Operator. Even though telecheric mechanisms use either hydraulic or servomotor 
actuators, which are usually controlled in a closed-loop manner, they are not robots 
because they require a human being to close the entire loop and to make the 
appropriate decisions about position and speed. Such devices are especially useful 
in dealing with hazardous substances such as radioactive waste. It has also been 





Figure 1.3.2. The G.E. Manmate Industrial M 
can be used for material handling. evice utilizes servo controlled hydraulic actuators 
and force feedback to the master control, 
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Electric Company, Peterborough, Ontario, Canada.) 
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proposed that they be used in undersea exploration. An example of an existing 
telecheric mechanism is the arm that is installed on the NASA Space Shuttle (mis- 
takenly referred to by the press as a “robotic arm’). Another example is the 
General Electric Corporation’s Manmate, a device developed in 1967 (See Figure 
Lose), 


4. Locomotive Mechanisms. These are devices that imitate human beings or 
animals by having the ability to walk on two or four legs. Although the multiple 
appendages can be highly sophisticated collections of linkages that are hydraulically 
or electrically actuated under closed-loop control, a human operator is still required 
to execute the locomotive process (i.e., make decisions concerning the desired 
direction of the device and to coordinate limb motion to achieve this goal). An 
artists rendering of the previously mentioned and ill-fated General Electric four- 
legged vehicle is shown in Figure 1.3.3. 

Having described what is not a robot, we now devote the remainder of this 
section to classifying the various types of robotic devices. As mentioned above, 
the approach taken will be similar to that suggested by Engelberger in his book. 
Classification will be performed in two different ways, based on: 


e The particular coordinate system utilized in designing the mechanical structure 
e The method of controlling the various robotic axes 


We consider the coordinate system approach first. 


1.3.2 Classification by Coordinate System 


Although the mechanics of a robotic manipulator can vary considerably, all 
robots must be able to move a part (or another type of “‘load’’) to some point in 
space. The major axes of the device, normally consisting of the two or three joints 
or degrees of freedom that are the most mechanically robust (and often located 
closest to the base), are used for this purpose. The majority of robots, therefore, 


Figure 1.3.3. The General Electric 
four-legged walking machine. Because 
of severe stability problems, the project 
was never completed. 








14 Introduction Chap. 1 


fall into one of four categories with respect to the coordinate system employed in 
the design of these axes. That is, they can be described as being either cylindrical, 


ee jointed, or Cartesian devices. Each of these categories is now discussed 
riefly. 


1.3.2.1 Cylindrical coordinate robots 


. When _a horizontal_ arm (or “‘boom’’) is mounted on a vertical column and 
this column is then mounted on a rotating base, the configuration is referred to as 
a cylindrical coordinate robot. This is shown in Figure 1.3.4. As can be seen, 
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Figure 1.3.4. A cylindrical coordinate robot: (a) a seneral view of the geometry of the 


robot’s major axes; (b) vertical and top views of the workspace of s 
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Figure 1.3.5. An actual cylindrical coordinate robot manufactured by Cincinnati 
Milacron. Called a T3300, this unit has 3 or 4 axes, is electrically servo controlled, 
and can handle loads up to 50 kg. (Courtesy of J. Coshnitzke, Cincinnati Milacron, 


Cincinnati, OH.) 


the arm has the ability to move in and out (in the r direction), the carriage can 
move up and down on the column (in the z direction), and the arm and carriage 
assembly can rotate as a unit on the base (in the 6 direction). Usually, a full 360° 
rotation in @ is not permitted, due to restrictions imposed by hydraulic, electrical, 
or pneumatic connections or lines. Also, there is a minimum, as well as a maximum 
extension (i.e., R), due to mechanical requirements. Consequently, the overall 
volume or work envelope is a portion of a cylinder. Commercial robots having 
this configuration are (or have been) manufactured by companies such as Prab, 
Versatran, Autoplace, General Numeric, Seiko, and Cincinnati Milacron. One 
such unit is shown in Figure 1.3.5. 


1.3.2.2 Spherical coordinate robots 


When a robotic manipulator bears a resemblance to a tank turret, it is clas- 
sified as a spherical coordinate device (see Figure 1.3.6). The reader should 
observe that the arm can move in and out (in the r direction) and is characterized 
as being a telescoping boom, can pivot in a vertical plane (in the direction), and 
can rotate in a horizontal plane about the base (in the @ direction). Because of 
mechanical and/or actuator connection limitations, the work envelope of such a 
robot is a portion of asphere. Commercially available spherical coordinate robots 
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Myure 1.3.7, A United States Robots, Ine., Maker [10 
robot, The unit has 5 electrically servo controlled axes 
lO Ibs, (Courtesy of G, Heatherston 


pure spherical geometry 
and can lift loads up to 
wid ULS, Robots, Ine., a Square D Company, ) 


are being built by Prab, Unimation, and United States Robots, A United States 
Robots’ Maker 110 is shown in Figure 1,3,7, 


1.3.2.3 Jointed arm robots 


There are actually three different types of jointed arm robots: (1) pure spher- 
ical, (2) parallelogram spherical, and (3) cylindrical, We briefly describe each of 
these in turn, 


I, Pure Spherical, \n this, the most common of the jointed configurations, 
all of the links of the robot are pivoted and hence can move ina rotary or “‘revolute”’ 
manner, The major advantage of this design is that it is possible to reach close 
to the base of the robot and over any obstacles that are within its workspace. As 
shown in Figure 1.3.8, the upper portion of the arm is connected to the lower 
portion (or forearm). The pivot point is often referred to as an “elbow” joint and 
permits rotation of the forearm (in the a direction). The upper arm is connected 
to a base (or sometimes a trunk). Motion ina plane perpendicular to the base is 
possible at this shoulder joint (in the 8 direction). The base or trunk is also free 
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Figure 1.3.8. Geometry of a pure spherical jointed robot. (Courtesy of J. Coshn- 
itzke, Cincinnati Milacron, Cincinnati, OH.) 


to rotate, thereby permitting the entire assembly to move in a plane parallel to the 
base (in the y direction). The work envelope of a robot having this arrangement 
is approximately spherical. Examples of commercial manipulators having this 
geometry are the Puma (Unimation), the Cincinnati Milacron T3, and those made 
by ASEA, Niko, and GCA. Three different sizes of Pumas are shown in Figure 
1.3.9. 


2. Parallelogram Jointed. Here the single rigid-member upper arm is re- 
placed by a multiple closed-linkage arrangement in the form of a parallelogram 
(see Figure 1.3.10). The major advantage of this configuration is that it permits 
the joint actuators to be placed close to, or on the base of, the robot itself. This 
means that they are not carried in or on the forearm or upper arm itself, so that 
the arm inertia and weight are considerably reduced. The result is a larger load 
capacity than is possible in a jointed spherical device for the same-size actuators. 
Another advantage of the configuration is that it produces a manipulator that 1s 
mechanically stiffer than most others. The major disadvantage of the parallelo- 
gram arrangement is that the robot has a limited workspace compared to a com- 
parable jointed spherical robot. Examples of such commercial units are those 


manufactured by ASEA, Hitachi, Cincinnati Milacron, Yaskawa, and Toshiba. 
The latter manipulator is shown in Figure 1.3.11. 


3. Jointed Cylindrical. _1n this configuration, the single r-axis member in a 
pure cylindrical device is replaced by a multiple-linked open kinematic chain, as 
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(b) 
{A is an example of a pure spherical jointed 
n are 3 different sizes, the 200, 500, and 700 series. (Courtesy of 
_a Westinghouse Company, Danbury, CT.) 


Figure 1.3.9. The Unimation PUN 


robot. Show 
Unimation, Inc. 
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Figure 1.3.9. Continued. 


shown in Figure 1.3.12. Such robots tend to be precise and fast but will generally 
have a limited vertical (z direction) reach. Often the z-axis motion is controlled 
using simple (open-loop) air cylinders or stepper motors, whereas the other axes 
make use of more elaborate electrical actuation (€.g., servomotors and feedback). 
Robots having this configuration are made by Hirata, Reis, GCA, and United 
States Robots. 

A subclass of the jointed cylindrical manipulator is the selective compliance 
assembly robot arm (or SCARA) type of robot [23]. Typically, these devices are 
relatively inexpensive and are used in applications that require rapid and smooth 
motions. One particularly attractive feature, selective compliance, is extremely 
useful in assembly operations requiring insertions of objects into holes (e.g., pegs 
orscrews). Because of its construction. the SCARA is extremely stiff in the vertical 
direction but has some lateral ‘‘give” (i.e. compliance), thereby facilitating the 
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Figure 1.3.10. Workspace and geometry of a parallelogram spherical jointed ro- 
bot. (Courtesy of Toshiba/Houston International Corp., Houston, TX.) 
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Figure 1.3.11. Example of an actual 
parallelogram spherical jointed robot. 
This unit, manufactured by Toshiba 
Corp., has 6 servo controlled axes, can 
lift loads up to 120 kg, and has a re- 
peatability of +1 mm. (Courtesy of 
Toshiba/Houston International Corp.., 
Houston, TX.) 





Insertion process. Some SCARAs even permit the lateral compliance to be in- 


creased during an operation by reducing appropriate electronic amplifier gains. 
Such a device is shown in Figure 1.3.13. 


1.3.2.4 Cartesian coordinate robots 


In this, the simplest of configurations. the links of the manipulator are con- 
strained to move in a linear manner. Axes of a robotic device that behave in this 


way are referred to as “prismatic.” Let us now consider the two types of Cartesian 
devices. 


1, Cantilevered Cartesian. As shown in Figure 1.3.14, the arm is connected 
to a trunk, which in turn is attached to a base. It is seen that the members of the 
robot manipulator are constrained to move in directions parallel to the Cartesian 
x, y, and z axes. Such a robot is shown in Figure 1.3.15. Devices like these tend 
to have a limited extension from the Support frame, are less rigid, but have a less 
restricted workspace than other robots. In addition, they have good repeatability 
and accuracy (even better than the SCARA types) and are easier to program 
because of the ‘‘more natural” coordinate system. Certain types of motions may 
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Figure 1.3.12. Jointed cylindrical 
workspace and geometry robot: (a) ver- 
tical cross-section; (b) top view. In 
some SCARA robots, tT, = 0 and the z 
axis is located at the wrist. Also, wrist 
(b) could have a pitch axis. 





be more difficult to achieve with this configuration, due to the significant amount 
of computation required (e.g., straight line in a direction not parallel to any axis). 
In this respect, Control Automation did manufacture a robot that was capable of 
unrestricted straight-line paths. However, since 1985, the company has stopped 


marketing such a manipulator. 


Normally used when extremely heavy loads must 


2. Gantry-Style Cartesian. 
re often mounted on the ceiling. They are 


be precisely moved, such robots a 
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Figure 1.3.14. Cantilevered Cartesian robot geometry. 


a honzontal plane that also passes through the arm) are possible. Moreover, the 
entire base of the robot can be mounted on a device that permits motion in a plane 
(e.g., an x-y table or a track located in either the ceiling or floor). From this 
discussion it should be clear to the reader that robots with as many as eight (and 
as few as two) axes can be constructed. 

Having classified robots according to the geometry of their major axes, we 
now look at another way of organizing robot types. 


1.3.3 Classification by Control Method 


As mentioned above, the second method of classification looks at the technique 
used to control the various axes of the robot. The two general classes are (1) non- 
servo controlled, and (2) servo controlled. We now consider each one separately. 


1.3.3.1 Non-servo-controlled robots 


From a control standpoint, the non-servo-controlled or limited-sequence robot 
is the simplest type. Other names often used to described such a manipulator are 
end point robot, pick-and-place robot, or bang-bang robot. Regardless of me- 
chanical configuration or use, the major characteristic of such devices is that their 
axes remain in motion until the limits of travel (or ‘end stops’) for each are reached. 
Thus only two positions for the individual axes are assumed. The non-servo nature 
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Figure 1.3.15. An actual cantilevereq 
Cartesian robot. (Courtesy of Seiko 
Instruments, USA, Inc., Torrance, 
CA.) 





of the control implies that once the manipulator has begun to move, it will continue 
to do so until the appropriate end stop is reached. There will be no monitoring 
(via external sensors) of the motion at any intermediate points. As such, one 
refers to this class of robot as being controlled in an open-loop manner. 

“Programming” a limited-sequence robot 1s accomplished by setting a desired 
sequence of moves and adjusting the end stops for each axis accordingly. The 
manipulator “brain” consists of a controller/sequencer. The “sequencer” portion 
is generally a motor-driven rotary device (similar to the “timer motor” found in 
certain home appliances) with a number of electrical contacts. Unlike the timer 
motor on a washing machine, for example, a series of jumper plugs is used and 
permits the appropriate contacts to be enabled by the sequencer in the desired 
order. Each such enabled contact will cause power to be switched to an axis 
actuator (e.g., pneumatic or hydraulic valve/piston arrangement) by the controller 
portion. The energized axis will continue to move until the “programmed” end 
stop is reached. This information is then used to cause the sequencer to index to 
the next step in its “program.” It is important for the reader to understand that 
this is the only time that information is ‘fed back” to the sequencer. 
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Figure 1.3.16. Geometry of a Cartesian gantry style robot. (Courtesy of CIM- 
CORP, Inc., St. Paul, MN.) 


A typical operating sequence for a hydraulic or pneumatic non-servo-con- 
trolled robot is as follows: 


1. A program “start” causes the controller/sequencer to signal control valves on 
the manipulator’s actuators. 


2. This causes the appropriate valves to open, thereby permitting air or oil to 
flow into the corresponding pistons (actuators) and the member(s) of the 
manipulator begin to move. 

3. These valves remain open and the members continue to move until they are 
physically restrained from doing so by coming into contact with appropriately 
placed end stops. 

4. Limit switches, generally located on the end stop assemblies, signal the end 
of travel to the controller/sequencer, which commands the open valves to 
close. 
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Figure 1.3.17. An actual Cartesian gantry robot, a Cincinnati Milacron T3886. This unit 
can lift loads up to 90 kg and has 6 electrically actuated servo controlled axes. (Courtesy 
of J. Coshnitzke, Cincinnati Milacron, Cincinnati, OH.) 


5. The sequencer now indexes to the next step and the controller again outputs 
signals to actuator valves, thereby causing other members of the manipulator 
to move. Alternatively, signals can be sent to an external device such as a 
“gripper,” causing it to open or close as desired. 

6. The process is repeated until all steps in the sequence are executed. 


Other attributes and/or capabilities worthy of mention for this class of robot 
are as follows: 


e Conditional modification of the Programmed sequence is possible if some 
type of external sensor is employed, For example, if a simple optical inter 
rupter (sce Chapter 5) is used, it may be possible to have the manipulator 
pause in its sequence until a peripheral too! (e.g., a punch press) has cleare 
the work envelope. Robots having this ability normally can perform on 
program. 


e Open-loop or non-servo control is often used in smaller robots because of !'* 
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Figure 1.3.18. Example of a three de- 


( gree-of-freedom wrist showing the roll, 


a ad O Roll pitch, and yaw axes. These robotic 
O 


Pitch joints are used for orienting objects in 


space. 


low cost and simplicity. An example of such a device is the Seiko PN-100, 
shown in Figure 1.3.19. 


It is possible to have a number of “intermediate” stops for each of the axes. 
This allows the manipulator to be programmed for more complex paths and 
permits a limited degree of path control. 


Although the controller normally applies full power to an axis that is selected 
by the sequencer and turns this power off only when the limit stop is reached, 
it is possible to achieve a degree of deceleration into the stop by using shock 
absorbers or appropriate valving at the end stops. This results in less stress 
on the components of the manipulator and on the part being moved. 


Even though limited sequence robots can be configured in a variety of ways 
Cartesian, cylindrical, etc.), a number of characteristics are common to all 


such devices. In particular: 


e They are relatively high speed machines because of the small size of the arm 


and the full power applied to the axis actuators. 


e They are low cost and easy to maintain and operate. Also, they are extremely 


reliable devices. 

They have a repeatability of about +0.01 inch. That is, they have the ability 
to return to the same point within +10 mils. (A few small pneumatically 
actuated robots such as the Seiko PN-100 advertise repeatabilities of about 
+(0),5 mil). 

This class of robot has limited flexibility with respect to positioning and 
programming. Thus although more than one axis can be moved at a time, 
it is generally not possible to cause a tool held at the end of the manipulator 
to move in a straight line (except if the desired line happens to coincide with 
one of the robot axes). Also, coordinated motion cannot be produced whereby 
the axes reach the endpoint of the desired motion at the same instant. 
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Figure 1.3.19. Seiko PN-100 pneumatically actuated 2-4 axis non-servo (point-to- 
The unit shown has 2 axes, can handle a payload of up to 1.5 kg, 
and uses adjustable limit stops for “‘programming.” (Courtesy of Seiko Instru- 
ments, USA, Inc., Torrance, CA.) 


point) robot. 


1.3.3.2 Servo-controlled robots 


Servo-controlled robots are normally subdivided into either continuous-path 
or point-to-point devices. In either case, however, information about the position 
and velocity (and perhaps other physical quantities) is continuously monitored and 
fed back to the control system associated with each of the joints of the robot. 
Consequently, each axis loop is ‘“‘closed.’’ Use of closed-loop control permits the 
manipulator’s members to be commanded to move and stop anywhere within the 
limits of travel for the individual axes. (The reader should contrast this with the 
non-servo-controlled machines described above, where only axis extremes coul 
be programmed.) In addition, it is possible to control the velocity, acceleration. 
deceleration, and jerk (i.e., the time derivative of acceleration) for the various 
axes between the endpoints. Manipulator vibration can. as a consequence, ‘i 
reduced significantly. Besides the above. servo-controlled robots also have the 
following additional features and/or attributes: 

e A larger memory capacity than in non-servo-controlled devices. This implies 
that they are able to store more positions (or points in space) and hence tha 
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the motions can be significantly more complex and smoother. It also means 
that more than one program can be created and stored. thereby permitting 


the robot to be used in a variety of applications with a minimum of downtime 
required for the changeover. 


The end of the manipulator can be moved in any one of three different classes 
of motion: point-to-point (where the endpoints of the motion are important 
but the path connecting them is not), straight line [where it is important to 
cause a specified location on the manipulator, often referred to as the tool 
point, to move from the initial point to the final one in a linear fashion (in 
three-dimensional space)], or continuous path [where points along the path 
are connected so that the instantaneous position and either its spatial or time 
(i.e., velocity) derivative are continuous]. Note that not every servo-con- 
trolled robot is capable of performing straight-line and/or continuous-path 
motion. Also, it may not always be possible to maintain a constant path 
velocity if all points along a desired path have been taught at the same speed. 
(This is due to the often complex geometry that relates the tool point to the 
individual joints. See Chapter 8.) 


Within the limits imposed by the mechanical components, positional accuracy 
can be varied by adjusting the gains of appropriate amplifiers in the servo 
loops. 


Joint actuators are usually either hydraulic valve/piston arrangements or ser- 
vomotors, although until about 1985 there did exist at least one commercially 
available robot that used pneumatic servos (see Figure 1.3.20). 


Programming is generally done in what is referred to as teach mode. The 
manipulator is manually moved to a sequence of desired points. The co- 
ordinates of each of these are stored in the robot’s (semiconductor) memory. 
Some of the more sophisticated systems actually have a specialized computer 
language that permits these stored points to be utilized in a variety of motions, 
paths, orientations, andsoon. Anexample of sucha language is Unimation’s 
VAL (or VAL II [24]). 


It is possible to program each axis to move to almost any point along its entire 
range of travel. Consequently, this affords the user with a great deal of 
flexibility in the type of motions that are possible. Moreover, ‘‘coordinated 
motion”’ can be achieved whereby two or more joints move simultaneously 
so that the end of the manipulator is capable of tracing out an extremely 
complex path. It is important to understand that such coordination among 
the robot axes is normally done ‘automatically’ under mini- or microcom- 
puter control. 


It is possible to permit branching operations whereby alternative actions are 
taken by the manipulator based on data obtained from external sensors. For 
example, it might be possible for the robot to repeat a particular set of moves 
if a part did not appear at a workstation because of a faulty feed mechanism. 
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Figure 1.3.20. Until approximately 1985, IRI (International Robomation Intel- 
ligence) produced an air servo robot that looked very similar to its newer M 50 E 
AC servo-controlled robot pictured here. The air version had severe vibration 
problems caused, in part, by the compressibility of air. (Courtesy of C. Gordanella, 
International Robomation Intelligence, Carlsbad, CA.) 


This capability arises from the extensive use of microprocessors in the robot 
controller. 


¢ Because servo-controlled robots generally have considerably more complex 


control, computer, and mechanical structures than non-servo-controlled de- 
vices, they may be more expensive and somewhat less reliable. Nevertheless. 


their great flexibility makes them extremely attractive and cost-effective ina 
large number of applications. 


With these features in mind, the following represents a typical operating 


sequence for a general servo-controlled robot (it is assumed that the desired points 
have been taught and stored in memory prior to running the program): 


F 


At the beginning of the program, the actual position of all of the manipulatot 
joints often — appropriately mounted sensors. The desired (0 
mand) position information is sent indivi as 
sent out to the ‘ ma maste! 
seeniinn individual axes from é 
For each joint, the actual 


and desired positi error” 
icf 1ONS <¢ an err 
signal is formed. P are compared and a 


dk 1S 1S ‘A ° : ei 

pgs his is used lo drive the individual joint actuators. 

ad - a ne — Of the robotic manipulator move. Position, velocity: 

(again util cr physical parameter of the motion are monitored or estimatt 

a IMZINg appropriate sensors 
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4. When the error signals for all the individual axes are zero, the members stop 

moving and the manipulator is “home” fi.e.. at the desired (or taught) final 
point in space). 

. The master computer then sends out the next taught point. and steps | through 

4 are repeated. This process continues until all of the desired points (or 


actions, ¢.g., opening or closing of a gripper) have been reached (or per- 
formed), 


Although most servo-controlled robots behave in the general manner de- 
scribed above, there are certain features that are specific to the point-to-point and 
the continuous-path robots. We next consider these briefly. 


1.3.3.3 Point-to-point servo-controlled robots 


Point-to-point robots are widely used for moving parts from one location to 
another and also for handling various types of tools. Although they can perform 
all of the tasks of the pick-and-place robot, they are far more versatile because ot 
their ability to be multiply programmed and also because of their program storage 
capability. A typical point-to-point application might be the unloading or loading 
of a pallet of parts. In the former case, the robot would be taught (1.e., pro- 
grammed) each of the n locations on the pallet. (Alternatively, the first point and 
the x and y offsets for each of the other pallet locations would be taught.) It would 
then move to the first of these taught points, pick up the part, move to a position 
above the conveyor, and place the part onto the conveyor. The manipulator would 
repeat the action for each of the remaining (n — 1) locations on the pallet. Such 
an application, while possible with a simple, nonservo pick-and-place device, would 
probably require a servo-driven x-y table that would actually move the pallet relative 
to the fixed pickup point. An example of loading a pallet is shown in Figure 
Leeks | | 

For the class of closed-loop control robot being considered here, only the 
initial and final points are taught. The path used to connect the two points Is 
unimportant and is, therefore, not programmed by the user. (The computer cal- 
culates the actual path of the manipulator.) More sophisticated point-to-point 
robots permit straight-line or piecewise-linear motions. Others also permit the 
velocity of the individual joints to be a continuous function of time and also to be 
changed by the user, that is, the speed with which the device performs a desired 
task is user selectable. If no changes in what the robot will do are expected, the 
initially taught points can be stored in a permanent or read-only memory spemgial 
Alternatively, a combination of temporary or random access memory (RAM)* anc 

ROM can be used for teaching new points and storing the old ones. a 
In general, these robots have a working range and load capacity that 1s quite 





ie aNSIVE r. high-speed CMOS M, many robots now have 
*With the advent of Inexpensive, low-power, high spec CMC pas ee 
battery-backup memory, which effectively makes such read/write memory permanent, 
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Figure 1.3.21. Use of a robot in a palletizing operation. 
on a conveyor interrupts the light beam from 
mands the robot to acquire the part. 
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Figure 1.3.22. A UNIMATE 2000, hydraulically actuated point-to-point servo controlled 
robot. (Courtesy of Unimation, Inc., a Westinghouse Co., Danbury, CT.) 


where it is most important to follow a complex path through space and possibly 
to have the end of the arm move at high speeds. Examples of these applications 
include spray painting, polishing, grinding, and arc welding. In all instances, the 
tool carried by the manipulator is fairly light but the required motion to perform 
the task may be quite complex. A continuous-path (CP) robot is usually called 
for in these cases. 

Although points must still be taught prior to executing a program, the method 
of teaching is usually quite different from that used for the point-to-point servo- 
controlled robot. Unlike the procedure described above, points are not recorded 
manually in the CP robot. What happens is that in the teach mode, an automatic 
sampling routine is activated which can record points (and/or velocity information) 
at a rate of 60 to 80 times a second for approximately 2 minutes. An operator 
simply moves the tool over the desired path with the sampler running. The sam- 
pling rate is usually high enough so that when the recorded points are ‘“‘played 
back” (1.e., the program is run), extremely smooth motion results. It is clear that 
a large memory Is required since as many as 9600 points may be recorded in the 
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Figure 1.3.23. A 6-degree-of-freedom CP robot that can be used to apply indus- 
trial coatings including paint. (Courtesy of The DeVilbiss Co., Toledo, OH.) 


2-minute period. To facilitate the accurate recording of complex paths (e.g., in 
arc welding applications), the tool can be moved Over the desired path during the 
teaching phase at a slow speed. Playback, however, will be independent of the 
recorded speed, so rapid and accurate curve tracing is possible. An example of 
a CP robot is that produced by DeVilbiss and shown in Figure 1.3.23. 

It is important to understand that, in general, CP robots can be used for only 
a limited number of tasks and are often Single-task devices (e.g., spray painting 
and welding).* On the other hand, point-to-point robots sometimes have the 
ability to perform CP motion, although the method of teaching the large number 
of points is not nearly as convenient since each point must still be recorded ma” 


ually. Examples of such devices are the PUMA and the Maker 110 (see Fig! 
1.3.24), 


It should be apparent from the above that even though there are two general 


“As of this writing, the lack of fexibil 
achieved with CP robots when used to perforn 
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Figure 1.3.24. The Maker 110 robot can execute continuous path motion by 
teaching a large number of discrete points. (Courtesy of G. Heatherston and U.S. 
Robots, a Square D Company.) 


methods of robot classification, there are still a large number of different robot 
types. Despite this fact, many points of commonality among these diverse mech- 
anisms exist. This is the subject of the next section. 


1.4 MAJOR COMPONENTS OF A ROBOT 


Although the mechanical, electrical, and computational structure of robots can 
vary considerably, most have the following four major components in common: 
(1) a manipulator or arm (the “mechanical unit”), (2) one or more sensors, (3) a 
controller (the ‘“‘brain’’), and (4) a power supply. Let us briefly describe each of 
these in turn. 


1. The Manipulator. This is a collection of mechanical linkages connected 
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Chap , 
by joints to form an open-loop kinematic chain i a 3). Also inely 4 
are gears, coupling devices, and so on. The manipe ator 1s Capable of MOVeme 
in various directions and is said to do “the work”’ of the robot. In fact, the ter : 
“robot” and “Manipulator” are often used interchangeably, although, Strictly Deakin 
this is not correct. : 
Generally, joints of a manipulator fall into one of two Classes, e firs 
revolute, produces pure rotary motion. Consequently, the term TOtAry join, . 
often used to describe it. The second, prismatic, produces pure linear o; trang 
lational motion and as a result, is often referred to as a linear Joint. Each of the 
joints of a robot defines a joint axis about or along which the Particular link Cithe; 
rotates or slides (translates). Every joint axis defines a degree of freedom (DOF) 
So that the total number of DOFs is equal to the number of joints. Many robots 
have six DOFs, three for positioning (in space) and three for or lentation, although 
as discussed in Section 1.3.2, it is possible to have as few as two a 
eight degrees of freedom. 


nd as Many as 
Regardless of its mechanical configuration, the manipulator defj 


ned by the 
joint—link structure generally contai 


Ins three main structural elements: the arm. 
the wrist, and the hand (or end effector).* Besides the mechanical components, 
most manipulators also contain the devices for producing the mOvement of the 
various mechanical members. These devices are referred to as actuators and may 
be pneumatic, hydraulic, or electrical in nature (see Chapter 4). They are invar. 
lably coupled to the various mechanical links or joints (axes) of the arm either 
directly or indirectly. In the latter case, gears, belts, chains, harmonic drives, or 
lead screws can be used (see Chapter 3). | 
2. Sensory Devices. 
Status of the manipulator. 
desired motion. 
position, velocity, 
that can be fed back to the control unit 
mechanical system. More simply, 
individual links of the Manipulator 
positions. Regardless of how it is 
can be either analog, digital, or ac 
Sensors used in modern robot 


to produce the proper control of the 
the controller can be informed only when the 
have reached their preprogrammed final or end 


Ombination. 


Scan be divided into two general classes: 


e Nonvisual 
e Visual 


The first Group includes limit SWitches (e.g. proximity, photoelectric, OF 
mechanical), position sensors (€.g., optical ; 


. [S}; 
encoders, potentiometers, or resolve 





*The term arm is sometimes used in Place of Manipulato 
r. 
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velocity sensors (e.g., tachometers), or force and tactile sensors (for overload 
protection, path following, calibration, part recognition, or assembly work). These 
are discussed more fully in Chapter 5. The second group consists of vidicon, 
charge-coupled device (CCD), or charge injection device (CID) TV cameras cou- 
pled to appropriate image-detection hardware. They are used for tracking, object 
recognition, or object grasping and are discussed in Chapter 6. 


3. The Controller. Robot controllers generally perform three functions: 


e They initiate and terminate the motion of the individual components of the 
manipulator in a desired sequence and at specified points. 


e They store position and sequence data in their memory. 


e They permit the robot to be interfaced to the ‘‘outside” world via sensors 
mounted in the area where work is being performed (1.e., the workstation). 


To carry out these tasks, controllers must perform the necessary arithmetic 
computations for determining the correct manipulator path, speed, and position. 
They must also send signals to the joint-actuating devices (via interfaces) and utilize 
the information provided by the robot’s sensors. Finally, they must permit com- 
munication between peripheral devices and the manipulator. 

Robot controllers usually fall into one of the following classes: 


e Simple step sequencer 
e Pneumatic logic system 
e Electronic sequencer 

e Microcomputer 

e Minicomputer 


The first three are generally used in less expensive, open-loop-control robots, 
discussed in Section 1.3.3.1. The microcomputer-based robotic controller is the 
most commonly used device in the servo-controlled robots described in Section 
1.3.3.2. Minicomputer controllers are not common because they are currently not 
as cost-effective as microcomputers. 


4. The Power Conversion Unit. The purpose of this part of the robot ts to 
provide the necessary energy to the manipulator’s actuators. It can take the form 
of a power amplifier in the case of servomotor-actuated systems, or it can be a 
remote compressor when pneumatic or hydraulic devices are used. 


Up to this point, we have been concerned primarily with the classification of 
robots according to their geometry or control scheme (see Section 1.3). In ad- 
dition, we have briefly described in the current section the major components that 
one expects to find in any industrial robotic device. The remaining portions of 
the chapter are devoted to the reasons and justifications for using robots, the 
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able to perform a multitude of jobs with relatively minor mo om r an litth 
“downtime” needed when changing from one task to another. It Is elieved 
some economists and sociologists that the introduction of the TODO! Into the man- 
ufacturing process in the early 1960s signaled the arrival of the Second Industrial 
Revolution.” This rather remarkable statement gives some idea of the Impact that 
flexible automation has had in the industrial environment. To see why this should 
be so, let us look at the three major advantages (as identified by Engelberger in 
his book) that this new approach to automation has over the more traditional one. 


I. Reaction Time. In general, when a fixed automated device is to be used 
in a process for the first time, it must be designed, built 
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How could flexible automation help solve the problem? First, a robot 1s an 
off-the-shelf device. Once the appropriate type of unit ts selected, a rather short 
period will elapse before the robot is delivered to the factory. Once it ts uncrated, 
is essentially “ready to go” (this is what 1s meant by “off the shelf). In reality, 
a penod of time must be allocated for personnel fo become acclimated and for 
programming. Also, techniques and devices that permit the appropriate parts in 
the particular process to be properly presented to the rahot must be developed, 
although this will often be done during the planning stage and while the robot ts 
being built. These devices are referred to as the robotic fooling and might consist 
of a specialized gripper and various parts presentation mechanisms, such as sorters 
and shakers. In point of fact, it is the (possibly) unique gripper that permits the 
off-the-shelf robot to be customized to a particular task. (Note that a similar sort 
of tooling would also be necessary in the case of the fixed automated device, except 
of course, for the end effector.) In any case, it is most likely that the robot will 
be able to do the job after a relatively short period. Moreover, if any variability 
develops in the process, it will usually be quite easy to compensate for this with 
the robot. For example, if small size changes in metal castings occurred with time 
due to mold wear, it might be possible to handle any misalignment problems by 
modifying the robot’s program (or reteaching a few points). Such might not be 
true with the fixed automated device. 

It is clear that use of a robot may significantly reduce the lead time required 
to start producing a new product and will facilitate changes necessitated by process 
variability. Thus even though a robot may cost significantly more than the fixed 
automated equipment initially,* the robot will actually be less costly when time is 
factored in. 


2. Debugging. As mentioned above, once a fixed automated device is de- 
livered to the plant, it must be placed into operation. Due to the fact that it is a 
special-purpose electromechanical device for which there is little or no past history 
of operation, this will often require a good deal of “fine tuning.” For example, 
limit switches and perhaps other sensors will have to be correctly positioned, so- 
lenoids properly adjusted, and so on. In some instances, it may even be necessary 
to redesign and rebuild entire portions of the machine before satisfactory operation 
is achieved, All of this will, no doubt, make the debugging or shakedown part of 
the procedure a time-consuming affair. 

On the other hand, if a robot is to be used to perform the same task (or 
tasks), the debugging operation will take a significantly shorter time. Since the 
robot is an off-the-shelf piece of automation, power connections, perhaps com- 
pressed air lines, and proper positioning (on a stand and near the workstation) will 
be required. (Note that the fixed automated device may need power and actuator 
feeds too.) Also, the appropriate gripper (or grippers) will have to be available, 
although such devices were probably ordered at the same time as the robot. 


"This is certainly not always true since robots may actually be less costly. 
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As noted above, the robot itself will be operational almost immediately, 
However, additional time will be required for the programming of the device 
Generally, this will mean teaching the points in the workspace that the Manipulato, 
must move to in order to perform the desired tasks. In addition, It May also be 
necessary to install simple sensors (e.g., optical switches) that permit the robot to 
interact with other equipment in its workcell. Nevertheless, it should be fair] 
evident to the reader that debugging time for the robot 1s likely to be considerably 
Shorter than for the special-purpose, hard automated device. 


3. Resistance to Obsolescence. Engelberger has said that resistance to ob. 
solescence is the ‘‘very essence of a robot.” Unlike a piece of fixed automation 
which is capable of performing only a single, specific task, the robot is not limiteq 
by the nature of the product, the type of operations to be performed, Or the 
particular industry. In fact, many of the robots that were purchased in the early 
1960s are still Operational despite the fact that they are considerably less sophis- 
ticated than modern-day units. It is this aspect that makes flexible automation 
Such an attractive alternative to companies that regularly require model changes 
that necessitate retooling (e.g., the automobile industry). These industries can 
now retool, in part, by reprogramming their robots and also by utilizing different 
types of grippers (although this may not always be necessary). Consequently, 
downtime and costs can be reduced considerably. 

The “conventional wisdom” concerning the use of robots is that they should 
be considered in operations that require periodic modifications to the process or 
where it is expected that a variety of items will be produced over a specific time. 
Although this wisdom seems to be reasonable, manufacturers who ncimally would 
use hard automation in making their limited variety of products are now considering 
or actually utilizing robots also. The reason for this apparent “‘misuse”’ of flexible 
automation is simply stated—cost! 

These manufacturers have discovered that because a robot can be 
operation in a much shorter time when the design, building, 
fixed automated device are taken into account, they can probably begin to produce 
their product much faster. Also, even though a robot is a complex device, its 
capital cost may actually be /ower than that of a comparable hard automated 
machine. For although the cost of developing a robot may be great, it can be 
amortized over a large number of units and many different customers, whereas all 
of the development costs for special-purpose devices must usually be borne by a 


single user. Consequently, on a per unit basis, these costs will be relatively small 
when a large number is to be purchased. 


Another reason for selecting a robot in “ 
cations 1s ease of operation. A robot tends to be quite ‘‘user friendly.’’ To become 
proficient in its use generally requires only a few days, although additional time 
will inevitably be needed to program and debug the input/output devices, feeder 
mechanisms, and any other peripherals. Consequently, it is possible to use the 
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traditional’’ fixed automated appli- 


Sec. 1.6 Economic Considerations 43 


robot in the manufacturing process in ways that were not imagined initially. For 
example, as experience is gained in making a new product. the robot can readily 
adapt to efficiency-increasing changes in the process that become apparent only 
after some time. With a fixed automated device, any unanticipated problems or 
manufacturing shortcuts generally require a major redesign. This is likely to be 
both costly and time consuming, 

The final reason for choosing a robot to perform a limited range of tasks Is 
that, besides the time and cost factors discussed above, the device can always handle 
other manufacturing tasks, if necessary. The manufacturer recognizes that even 
though modification or complete change over of a process cannot be (or is not) 
anticipated at the time of purchase, the robot will be able to adapt to the new 
situation if the time ever arises when change is necessary or desirable. Although 
it does not cost any more to get the ability to change, it is the knowledge that it 
is there which is comforting. Of course, this is one of the major advantages of 
flexible automation. 

We have shown in this section that the use of robots in the manufacturing 
environment certainly seems to be justified from a qualitative point of view. How- 
ever, in business, it is often the “bottom line” that dictates whether or not a certain 


policy will or will not be acceptable. In the next section, we explore briefly the 
economic justifications of using robots. 


1.6 ECONOMIC CONSIDERATIONS 


Although it is certainly true that robots can relieve humans of the need to perform 
what has been called ‘3D jobs” (i.e., a very dirty, very dangerous, or very difficult 
jobs), the fact remains that manufacturing plant managers are extremely concerned 
with the “bottom line.” A survey of robot users and potential users conducted 
in 1981 by the Carnegie—Mellon University Robotics Institute indicates that the 
primary reason for selecting a robot is to reduce labor costs. See Table 1.7.3 in 
the following section. Thus regardless of how potentially beneficial robots may 
appear to be with respect to humans, if they cannot be justified economically, they 
will not be purchased. The purpose of this section is to present briefly some simple 
techniques that have been used to demonstrate that, indeed, robots can rather 
casily be shown to be an economically justifiable capital expenditure. It is not 
our intention, however, to develop sophisticated economic theories. as that is 
beyond the scope of this book, 

Today, the price of a single industrial robot ranges from about $10,000 to 
well over $100,000. To this must be added the cost of the associated tooling and 
fixturing that are to be used within the robot work cell and also the cost of the 
installation itself. It has been found that approximately 55% of the overall system 
cost is for the robot, 30% is for the additional tooling, and about 15% is for 
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installation. Let us consider a system with a total cost of $100,000 broken down 
as follows: 


e Materials-handling robot $55,000 
e Tooling and fixturing $30,000 
e Installation $15,000 


It should be noted that the figure used for this type of robot IS about the 
current average in the United States. Also, the tooling and fixturing figure Includes 
engineering development costs. 

To determine the economics of such a robot, we need to know the COst of 
labor and of the operation of the robot itself. It was estimated that In 1982, an 
automobile worker earned about $17 per hour, including fringe benefits. In aq. 
dition, the Draper Laboratory at MIT has estimated that 1t costs about $6 per hour 
to run a robot based on operating 16 hours per day (i.e., two shifts per day) and 
a useful life of about 8 years. (Although other sources suggest a figure of $9 
hour,* many robot manufacturers use the more conservative number.) Since 
worker will normally put in about 2000 hours per year (40 hours/week x 50 weeks), 
it can be seen that the $11/hour differential in labor costs ($17 — $6) produced by 
the robot results in a yearly “saving” of about $22,000. Thus it will take about 
2.8 years to pay back the original cost of the robot ($55,000/$22,000). After this 
time, the user will be “making” $22,000 per year or, more correctly, will be ex- 
periencing a positive cash flow. If we assume a two-shift-per-day activity, the 


payback period will be only 1.4 years, after which time a cash flow of $44 ,000/year 
will occur. 


Even if we take into account the entire s 
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“Richard C. Dorf, Robotics, Addison-Wesley Publishing Company, Inc Reading, Mass., 1985, 
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It can be shown that the payback period Y can be calculated from the following 
equation: 


Ca, eae o ee 


Y= 
(L + M— O) x H x (1 — TR) + DX TR 


where Y = number of years required to break even 

= price of the robot = $55,000 

cost of the tooling and fixturing = $30,000 

installation cost = $15,000 

= investment tax credit* (assumed to be 10%) = $10,000 

hourly cost of labor, including fringe benefits = $17 

hourly savings in the cost of materials = $1 

cost of running and maintaining the robot system = $6 

= number of hours per year per shift = 2000 

= annual depreciation assuming an 8-year ‘“‘tax life,’* the straight-line 
method, and a salvage value of $10,000: = ($100,000 — $10,000)/8 

| = $11,250 

TR = corporate tax rate,* assumed to be 40% (= 0.4). 


SMoOKrONDB’ 
l| 


Substituting these values into the foregoing equation gives a payback period 
of 4.8 years for a single-shift operation and 2.7 years for a double-shift operation. 
It should be noted that this result does not take into account the time value of 
money, which could be done by using discounted cash flows. We will, however, 
not do such an analysis. 

Another economic yardstick that is often used in determining whether a 
particular capital expenditure is warranted or not is the return on investment (ROI). 
Defined as the ratio of the total annual savings realized from the equipment divided 
by the total investment (and expressed as a percentage), if the ROI is larger than 
the current percentage rate of borrowing money (e.g., assumed here to be about 
20% but obviously subject to change, depending on the economic and political 
climate existing at the time the analysis is performed), the purchase is usually 
justified. We may write 


total annual savings 


x 100 
total investment to 


ROI = 


In terms of the quantities defined above, this can be expressed as 


(L+M-0O)xH-D 


P+A+1-c 1 


ROI = 


“The Tax Law of 1986 modifies the actual value of this quantity, 
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ROIs become 23.1% and 58.6%, respectively. ; 

Other economic measures can also be used to determine if the Purchase of 
a robot is valid. These include the internal rate of return, which permits the time 
value of money to be included, and the total cost of labor analysis, which allows 
the labor costs over an extended period to be compared with the cost of running 
the robot for the same period of time. We will not discuss these here and the 
reader wishing to learn more about them or other techniques is referred to the 
References at the end of this chapter [25, 26, 27, 28, 29, 30]. 

One final point is worthy of mention. The quantitative measures describeq 
above do not take into consideration the economic benefits that can be derived 
from using a robot to produce a product that is of a consistently high quality. Ip 
addition, they do not permit an estimate of what the savings will be if a robot takes 
appropriate emergency action, thereby preventing an expensive process from being 
ruined. [One user actually estimated that because of frequent power outages in 
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Figure 1.6.1. A Maker 110 Robot [rom U.S. Robots, designed to work in a clean 
room environment, Is pictured in a semiconductor Wafer-etching application. 
(Courtesy of G. Heatherston and U.S. Robots, Inc., a Square D Company.) 
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his plant's area, the payback period for his robot would be one day! (See Figure 
1.6.1.) Also, based on the total amount of product that the robot could salvage 
over the period of one year, he felt that he could realize a potential savings of 
about $1 million.] Obviously, each user would have to make such a calculation 
using the set of circumstances and assumptions that are appropriate to the operation 
In question. It should be clear to the reader. however. that regardless of the 
application, such considerations are extremely important when trying to justify the 
purchase of a robot. In some instances, in fact, they may even be more important 
than a favorable ROI. 

The important result of this section has been to demonstrate clearly that from 
an economic point of view, robots seem to make a great deal of sense. However, 
what about the human element? What will be the impact on the workers them- 
selves of introducing these devices into the workplace? We present possible an- 
swers to these and other problems in the next section. 


1.7 SOCIOLOGICAL CONSEQUENCES OF ROBOTS 


The problems created by the introduction of machines into the workplace are not 
new. For example, the early part of the Industrial Revolution saw Adam Smith, 
in An Inquiry into the Nature and Causes of the Wealth of Nations, published in 
1776, expressing his concern that workers who sought to improve their economic 
circumstances might drive themselves so hard that their health would be adversely 
affected, even to the point of shortening their lives. Twenty-three years later, 
David Ricardo perceived that mechanization might be a double-edged sword, in 
that some workers who were displaced by machines might not be able to find new 
jobs. Thus what was good for the employer might not be good for the worker. 
By the middle of the nineteenth-century, Karl Marx wrote about the extensive job 
displacement suffered by millions of workers caused by the introduction of machines 
into the workplace, but incorrectly predicted the subsequent self-destruction of the 
capitalist system as a consequence. His error was in not recognizing that increased 
productivity due to mechanization would actually produce a substantial improve- 
ment in the economic and social well-being of future worker generations. 

With the introduction of the robot, the twentieth-century worker may well 
face many of the same problems as those of his eighteenth-century counterpart 
and, in addition, a host of others. If, as has been said, the robot will be the 
catalyst for initiating the second industrial revolution, an important question that 
must be asked is: What will be the effect on society as a whole and the individual 
worker in particular? Clearly, there are no pat answers to such a question, nor 
are there easy solutions to the problems that will inevitably arise, and in certain 
instances have already arisen, when robots and other high-level intelligent auto- 
mation devices are introduced into the manufacturing environment. In this section 
we wish to make the reader aware of the difficulties that American society will 
face as this new form of technology becomes a “‘way of life.” 
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In a paper presented at the Robots VI Conference held in Detroit in March 
1984, Sandra Pfister of Prab Robots, Inc. wrote that “it is increasingly apparen; 
that robotics, automation, and related high technology are the keys to nationa| 
[economic] survival.”[5] If the reader doubts the validity of this statement, the 
following facts should be considered: 


¢ In the past six years, U.S. productivity (defined as the ratio of total productigy 
to the units of labor) has grown at an annual rate of 0.01%, whereas in 1979 
alone, Germany had a 4.4% increase.[5] It should be noted, however, thay 
in congressional hearings held in the latter part of 1982, it was pointed oy 
that the Japanese worker is actually about 60% /ess productive than his Amer. 
ican counterpart. In the United States the problem has been that productivity 
has remained at the same level for a number of years, whereas countries such 
as Japan and Germany have had large increases in their productivity [6]. 


In 1981, a large Japanese company, Hitachi Ltd., assembled a force of 500 
technical people with the express purpose of developing by 1985 a universal 
assembly robot with visual and tactile sensing. In contrast to this, the largest 
manufacturer of robots in the United States, Unimation, Inc., a Division of 
Westinghouse, has only about 90 robotics engineers [7]. 


Renault, the French automobile giant, developed a “‘vertical robot” equipped 
with TV and sonar sensors that is used to locate, lift, turn, and move a 26- 
Ib crankshaft from a pallet to an assembly line. 


e Fujitsu Fanuc Ltd. has opened a plant that employs robots to produce about 
100 robots per month. Human beings are still used for final assembly, but 
they represent only 20% of the normal work force that would be required in 
a plant of the same size [8]. 


These and numerous other examples of foreign developments in the field of 
robots and associated automation have placed great pressure on American industry. 
In Table 1.7.1 it is observed that since 1980, Japan has been producing almost six 
times the number of robots per year as the United States. However, it is estimated 
that by 1990, this production gap will narrow to about three times. 

Although some of these devices have been exported, many have been used 
in Japanese industries. As shown in Table 1.7.2, it can be seen that the Japanese 
have enjoyed a significant numerical superiority over the rest of the world in the 
actual number of robots in use since 1980. It is important to note that the numbers 
for the Japanese units represent only those that satisfy the RIA definition of 
robot. As of 1983, there were about 96,000 additional nonprogrammable, fixed- 
sequence, and/or manual manipulators in use in Japanese industry. 

Obviously, a company cannot continue to ignore the fact that its foreigt 
competitors are making use of advanced technology if it is to remain financially 
healthy. Not surprisingly, many U.S. firms are introducing robot systems 1nt0 
their production plants. For example, McDonnell-Douglas is employing a million 
dollar robotic manipulator to control a laser beam that Cuts out sheets of graphite 
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TABLE 1.7.1 US AND JAPANESE ROROT PRODUCTION 
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Year U.S Japan 
1979 14 2.763 
1980) 1,118 4 A494 
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“Robot Industries Association, from Robotics Today. December [9X6, 


p. 9. 
(E) Estimate by Paul Aron 


Source except as noted: Paul Aron Report (#28), “The Robot Scene 
in Japan: The Second Update,’ Daiwa Securities America Inc.. April 


15, 1985. 


used in aircraft brakes. This device also forms tail and wing section parts that are 
then welded together by an arc-welding robot. Two workers and the robots now 


do work that previously took 30 people to do [9]. 


Also, Texas Instruments uses 


three robots to test its hand calculators. One brings a particular unit into the test 
area, another one presses the keys in a prescribed sequence, and the third looks 


for the correct numbers on the calculator’s display. 


In addition, Cheesebrough- 


Pond has a robot that places jars of skin cream into cartons from an assembly line. 


TABLE 1.7.2 
(U.S. DEFINITION) 


Country 1980 
Japan 14,246 
Soviet Union NA 
United States 4,100 


West Germany NA 


France NA 
Sweden 600) 
Great Britain 500 
Canada NA 
Belgium NA 
Poland NA 


1981 


21,684 
6,650 
4,700 
1,420 

620 
700 
3 
NA 
44 
NA 


L982 


33,961 
12,050 
6,301 
4,300 
993 
1,450 
977 

Aa 
305 
285 


INSTALLED ROBOT POPULATION 1980— 1983 


1983 


48,825 

25, 000(E) 
9361 
4,800 
3,600 

1 ,YOU(E) 
Loo 
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St4 
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(IZ) Estimate 


NA = Information not available 
Source: Paul Aron Report (#28), “The Robot Scene in Japan: The 
Second Update,” Daiwa Securities America Ine., April 15, 1985. 
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In the highly competitive and labor-intensive ae Meat ant 
dustry, U.S. companies have had robots working 1n presen me of the Ssembj, 
line alongside their human employees for a number of years. Most of these unit 
have come from American companies, probably due, in large part, to UNION ;. 

— d parts. However, the pressure + 

Strictions on using foreign devices and palt» Scat Chadies.. Ce © mee 
foreign competition has recently produced a Ble ee) h Be. ioe Moto; | 
a traditional stronghold of the “buy American philosop bd - 2 joined With 
Japan’s Fujitsu Fanuc Ltd. to form the GMF corporation, ee © express Purpose 
of designing, building, and marketing robots in the Unite ier The Plant jg 
located in Michigan, and GM currently buys about 75% of the units Produceq 
there for its own use. (The first robot delivered to GM actually came from Japan 
[10].) | 

It is clear from the small number of examples cited above that robots are 
here to stay and will be used by American industry. With this as a given, wha 
will be the effect on the American worker? Writing in the New Republic, Mark 
Miller of the University of Pennsylvania suggested that “the fear of robots is an 
apprehension of gradual displacement . . . a foreboding of our own annihilation” 
[11]. It appears that this ‘‘fear”’ is, to a certain extent, wellfounded. For exam le, 
General Electric projects that eventually it will replace almost half its 37,000 as. 
sembly workers with robots. The company feels that in some instances robots will 
increase productivity in their plants by 50% [12]. Also, it has been predicted that 
in the auto industry alone, as many as 100,000 jobs will be lost to robots by 1999 
[13]. Moreover, in a study conducted at Carnegie—Mellon University in 1980. 
Ayres and Miller predicted that by the year 2000 the current class of non-sensor- 
based robot would replace as many as 1 million manufacturing production workers. 
They also predicted that robots possessing some rudimentary tactile and vision 
sensing capabilities would replace about 3 million of these workers. Finally, they 
projected that by the year 2025, all the current 8 million manufacturing production 
workers could be expected to be replaced by highly sophisticated robots. To be 
sure, this would represent “only” about 8% of the total workforce today. Never- 
theless, when combined with unemployment in other areas, it could have a sig- 
nificant effect on the overall state of the nation’s economy [14]. Another study 
performed by International Resource Development, Inc. in 1982 suggests that of 
the 32.1 million blue-collar workers now in the United States, approximately 13 
million could be replaced by robots. Of these, about 25% would be retrained to 
program and maintain the robots. Interestingly enough, however, it 1s estimated 
that no more than about 18,000 workers have actually been displaced by robots 
despite the intense economic pressure from abroad. (The rule of thumb used by 
industry is that one robot displaces three workers.) Engelberger has stated that 


the reason for this is that few middle- and high-level managers in American industty 
have recognized that they need robots in their plants in order to meet forelg” 
competition successfully [13]. 

The fear of displacement is a 
In Japan, for example, the impa 


INg In. 


. : ee 
pparently not restricted to American sna 
ct of robots on the production worker }8 " 
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beginning to be felt. Several of that country’s largest labor unions have forced 
the government to undertake a study on this subject. These unions are frightened 
at the prospect of potential wide-scale job elimination within the next five to ten 
years. The reason for this concern is that companies that have ordinarily moved 
people displaced by robots to other areas of the same plant are now moving these 
people to new locations, sometimes in other cities. Moreover, Japanese plant 
managers indicate that they are slowly running out of jobs for the displaced and 
for new workers who are just coming into the work force, although unemployment 
in Japan is still a low 2.3% [15]. It is fairly clear that unemployment must someday 
begin to rise even in Japan if automation continues to replace people without a 
corresponding increase in jobs. Note that this runs contrary to the popular notion 
in the United States that all Japanese workers enjoy “cradle to grave job security” 
(in reality, only about 30% have this benefit). 

The key question, then, seems to be: Will the introduction of robots produce 
a net gain in the number of jobs, and if so, what will be the time frame to realize 
such an increase? History reveals that when machines were introduced at the 
beginning of the first industrial revolution, many jobs were lost for a significant 
period of time. No one would deny, however, that in the “long run,” the machines 
created many more jobs than were lost. What happened was that industries that 
had not existed before now began to develop. While workers in the traditional 
“cottage”’ industries lost their jobs, new jobs were created and people were trained 
for these. But robots may not be just another machine. George Brosseau of the 
National Science Foundation has been quoted as saying: “In the past, whenever a 
new technology has been introduced, it has always generated more jobs than it 
displaced. But we don’t know whether that’s true of robot technology. There’s 
no question that new jobs will be created, but will there be enough to offset the 
loss?” [10] 

Others are more optimistic in their outlook. For example, James Albus of 
the National Bureau of Standards has said that “‘robots create profits, profits create 
expansion in industry and expanding industries hire more people” [16]. Ayres 
and Miller [14], [22], [31] have suggested that these new jobs will require workers 
who are significantly more skilled than before: for example, those who are capable 
of building, repairing, and maintaining the robots. They also feel that a large 
number of jobs could be created if the robot revolution follows a course that is 
parallel to that of the computer, that 1s, if a market for the “home” (or ‘“‘personal’’) 
robot develops. 

Even if Albus, Ayres and Miller, and the robot manufacturers are correct, 
It is possible that history may repeat itself and initially there will be a significant 
loss of jobs directly traceable to the introduction of this new technology. Haz- 
ardous, repetitious, and boring jobs that human beings really should not be doing 
will be the first to go. In fact, this is already occurring in some industries. This 
may be applauded by some, but what of the people who lose these jobs? The 
United Auto Workers (UAW) union has estimated that by the end of this decade. 
assembly-line labor could be reduced by as much as 50% because of robots and 
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Source: CMU Robotics Survey, April 1981. 

other automated devices. This union has often encouraged me nieerae of 

technological advances in the automobile industry. But with ro ots it has had to 

look for novel ways to counteract the potential impact on its members. As 4 
da contract with the automobile companies 


consequence, the union has negotiate daca 
that provides for extra personal paid holidays. The idea is that existing jobs can 
then be distributed to more workers without a significant loss in pay. The problem 


with such a solution is that productivity may actually decrease. 

Other industries may not want or be able to do the same thing. For example. 
as shown in Table 1.7.3, when Carnegie—Mellon University questioned 38 members 
of the RIA (19 users and 19 potential users of robots), they discovered that the 
number one consideration for placing robots into factories was Reduction in Labor 
Costs [17]. The same conclusion was arrived at in a 1980 study conducted by 
MIT’s Draper Laboratory. These results are not that startling when one under- 
stands that between 1968 and 1978, labor costs in the United States rose by 250%. 
Pa apy in ie ae eae unemployment in the near term, the intro- 
; € work place will create some rather unique problems 
or human workers who remain employed. McVeigh point hat in the future 
such workers may be forced to interact with ee te sume tenes Wi 

ee = mach beings 

[18]. He predicts that this situation may cau —_ eet _— oe 
nication with others in a work situation js imp. veneer praca an ond 
making tim e pass more quickly on the job Parti In relieving monotony a? 
corporation decided to replace its human ra an example of this, a large chemica 
After it was put into service, the office m weap with a mobile robotic devi 
to people or take coffee breaks, so it ws anager found that it did not stop and talk 
the firm, rumors, and office _ iit efficient. However, ‘“‘news’’ aboul 
human being delivering the mail te in ich had Previously been supplied by the 
"eer Came from this link. Instead, the J 
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of delivering the mail was performed silently much to the annoyance of the other 
office workers, It turned out that the human mailman provided an important 
communications link which was broken by the robot [19]. 

McVeigh also states that new and old workers will have to compete in a ‘new 
system of labor” that is “functionally equivalent to slavery." Moreover, where 


human beings and robots work together, the human being will be forced to compete 
with an entity that: 


e Does not tire 


° Does not seek or obtain wage increases and fringe benefits, such as paid 
holidays and vacations 


e Does not go out on strike or slow down due to disagreements 
e Does not argue or debate the supervisor’s ideas 


What can be done to soften the inevitabie impact that robots will have on 


many American industrial workers? Ayres and Miller suggest the following pos- 
sibilities: 


e Industry should identify categories of jobs and workers that will be adversely 
affected by robots. For example, it is already quite clear that the need for 
human welders and machinists will diminish significantly in the near future. 
Also, Table 1.7.4, which compares the current distribution of jobs performed 
by robots with that expected by the year 1990, indicates that human beings 
will be competing with robots for jobs in several additional categories in the 
near future (e.g., certain types of assembly work). The important thing 1s 
that identification of the potentially affected job categories should be done 
well in advance of the reduction and/or elimination. For example, Table 
1.7.4 clearly shows that assembly jobs will be severely impacted by robots 


TABLE 1.7.4 JOBS DONE BY ROBOTS NOW AND 
IN THE FUTURE? 


Task Through 1981 By 1990 
Spot welding 35-45 3-5 
Arc welding 5-8 15-20 
Materials handling 25-30 30-35 


including machine 
loading and unloading 


Paint spraying 8-12 5 
Assembly 5-10 35-40 
Other S- 10 7-10 


“Numbers represent the percentage of total jobs per- 
formed by robots in the given year. 
Source: Bache Halsey Stuart Shields, Inc. 
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robots will be in this cate 
also that the reduction in 
jobs handled by robots 18 
not imply that the actual num | 
e Industry, government, and union 
of employment needs. 


e These groups should 
required in the future. 
in the job market so t 

e Education and job train 
workers whose jobs will be lost. | | | 

e Industry and government should create facilities to locate suitable jobs fo 
displaced workers and to help pay for their relocation. Of course, this as- 
sumes the availability of additional jobs. 


e Workers and employers shoul 
curity fund which would be use 
and retraining of displaced workers. 


identify and publicize the new job skills that will be 
This will alert young people to the changing patterns 

hat they can acquire marketable ae 

ing facilities should be established to help retraip 


d finance an actuarily sound national job se- 
d to pay for the transportation, maintenance, 


Clearly, some of these suggestions would be difficult to implement and may 
not solve the problems of all displaced workers. For example, it will be difficult 
(or perhaps even impossible) to retrain a worker who has performed the same task 
for over 20 years and has suddenly been replaced by a robot. 

From the discussion above, it seems apparent that robots will displace workers 
but may also create jobs. However, these jobs will be highly technical in nature 
and will therefore require a significant amount of training. Another consequence 
of the robot revolution is that workers may find themselves with more leisure time. 
It has been suggested that this would stimulate growth in industries related to 
recreation. In fact, a prediction made in 1956 “that the importance of work for 
people as a ‘central life interest’ may decline as robots replace them” may become 
a reality as the result of the use of this technology [20]. 
pcr fpr mip ema deemger = 
impact of these devices, we now return to ellen -_ any aa SE re 
: canara abt more concrete ideas and look very briefly 
at the characteristics of several commercial robots that lable or 
have been available in recent years. siiecieiaabaiiie availabe ° 
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of 152 different models were tabulated. As an indication of the rapid changes that 
are expected to take place in the robot industry in the next few years, the people at 
Stock Drive Products caution the reader to keep in mind the following when using 
the complete table (which is reproduced in its entirety in Appendix A). 


e The list is not complete and additional models (from these and other com- 
panies) may be available. 

e Some manufacturers may not carry a large inventory of spare parts. Others 
may actually be out of business now or in the near future. 


e Some of the manipulators have undergone little if any field testing and de- 
velopment. Some may be shipped without adequate (i.e., at least 50 hours) 
life testing in the factory. 


e The performance characteristics quoted in the table may not actually be 
achievable. 


e Not all manipulators listed in the table may currently be available. 


e There is a wide variety of capability between manufacturers in regard to both 
current and potential future customer service. 


e Some of the manipulators listed are for educational, not commercial use. 


To assist the reader in using the complete table, however, we have excerpted 
some of the voluminous information included in this compendium for a few select 
robots. This is shown in Table 1.8.1. 

In using this table (and the one in Appendix A), the reader should understand 
that the data contained therein must be carefully interpreted. For example, while 
the maximum tip speed may be 50 in./s, it is probably not possible to do this with 
the stated maximum load. Also, the price of the robot may, in certain cases, be 
for the minimum system and in other cases for the “Rolls-Royce” or fully acces- 
soried system. Finally, memory-capacity comparisons may be difficult since there 
is no single standard for this specification. For example, some manufacturers 
specify the number of program steps, others the number of programs, and still 
others the number of memory bytes. A more complete discussion of these and 
other robot features is given in Section 2.5. 

In addition to the data entries in Table 1.8.1, the more complete compilation 
found in Appendix A also gives the company’s telephone number, the extent of 
the major joints, the dexterity of the wrist joints, the type of memory devices used 
(e.g., semiconductor, magnetic tape, air logic, or mechanical stop sequencer), and 
whether or not the robot is considered suitable for “educational purposes. ” 

It is important to understand that the robotics industry is an extremely dy- 
namic one, with companies going into and out of business quite routinely. For 
example, as of this writing, Bendix, Copperweld, and Nordson are no longer in 
the field and Unimation has been acquired by Westinghouse Corporation. On 
the plus side, as mentioned previously, in 1983, General Motors joined with Fujitsu 
Fanuc of Japan to form the GMF Corporation. It Is expected that this type of 
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situation will continue to occur into the foreseeable future as the inevitable ‘‘shake- 
out” (perhaps accelerated by the worldwide economic weakness of the late 1970s 
and early 1980s) takes place. 

The robots listed in this section (and in Appendix A) can perform a variety 
of manufacturing tasks. The next section describes some of these in more detail 
and also indicates possible uses for robots in the future. 


1.9 ROBOTIC APPLICATIONS: CURRENT AND FUTURE 


In its relative infancy, the state of the art of robotic applications is, in some ways, 
paralleling the development of digital computers. When they were first introduced, 
computers were used for tasks that had previously been performed by people (with 
perhaps the assistance of some type of manual aid, such as a slide rule or mechanical 
calculator). This was a natural application, for it was obvious that the new device 
would be able to perform such jobs much faster and even more reliably than people 
could perform them. However, as time progressed, it was recognized that tasks 
that had heretofore been rejected as being impossible to undertake because of 
excessive manpower and/or time requirements were now possible to attempt. Thus 
problems that were “not practical” to solve were handled with relative ease. Be- 
sides being able to solve such problems, it became apparent that there were many 
applications for the computer that had never been thought of before its develop- 
ment. In a sense, what happened was that people took off their ‘‘blinders” and 
allowed their imaginations free reign. The result of this has been that computers 
are now applied in many areas other than the more traditional “number crunching” 
that was initially envisioned as the major use. The fields of control (of large-scale 
systems), learning and teaching devices, handling of large data bases, and artificial 
(or perhaps more descriptive, “autonomous”) intelligence come to mind, to name 
but a few nontraditional applications. But where do we stand with robots? 

As already mentioned in earlier sections of this chapter, the first applications 
of the robot have been in areas where human beings have traditionally been work- 
ing. Although there have been some significant technological advances in the 
design of robots (i.e., the hardware) since the first one was developed more than 
20 years ago, the manipulators currently being manufactured are, as a general rule, 
rather simple (e.g., most lack the ability to sense their external 
ronment). As a result, the state of the art in robot applications is probably where 
the computer was when it was used primarily for “computing.” It has taken a 
much longer time for the blinders to be taken off when talking about robots than 
it did with computers. One can cite a number of possible reasons for this. including 
the problems of recessions, fear of people losing their jobs, and the lack of a ma Jor 
scientific breakthrough comparable to the development of the transistor and later, 
the integrated circuit. Also, some of the first big users and/or developers of 
computers were in government, the military, and the universities. These three 
entities, which were responsible for developing many of the unique computer 


Or working envi- 


58 Introduction 
Appheations. have only recently entered the robot field in a |; ™ 
Program at the N i f By eau of Standards. having been sta ait, way, ( 
Ate shgahg National Bureau of Standards. . ak Cd in the jon, !h 
bate ct. exception.) The industrial sector has been the nner USer, and Bi 
% expected, the need to produce a “oood hottom-line result” has Preven Tigh 
least significantly reduced the risk taking required to produce new id fi OF a 
applications) and developmental research by manufacturers. The wee Le. 
Eenee of robot programs supported by both the military and state PB ame 
government may indicate that this situation is beginning to change, howeve ral 
a consequence, it is to be assumed that over the next few years. nontradi. 
robotic applications will begin to appear which will. in part, contribute am 
development of the fully automated factory or factory of the future. » the 
7 In the first part of this section we briefly summarize some of the More 
ditional uses for robots, some of which have already been mentioned in ea ni 
sections of this chapter. In the concluding portion of the section we indicate ni 
1 r — futuristic applications that have been proposed by some workers 
e field. | 


1.9.1. Current Robotic Applications 


In the preceding two sections we encountered a number of applications of today’, 
industrial robots. For example, in Section 1.7 it was indicated that welding, sind 
ing, and spray painting account for the majority of applications of the current 
generation of robots. In addition, Section 1.8 listed a total of 13 appplications for 
robots that were available in 1982.* We now briefly describe a number of these. 


1.9.1.1 Welding 


Welding is one of the major uses for an industrial robot. Actually, two 
distinct types of welding operations are readily and economically performed by 
robots: spot and arc welding. In the former case, the robot 1s taught a series ot 
distinct points. Since the metal parts that are to be joined may be quite irregular 
(in three dimensions), a wrist with good dexterity is often required (¢.g., three 
degrees of freedom). This permits the welding tool to be aligned properly at the 
desired weld point without the gun coming into contact with other portions of the 
part. Typically, the welding tools carried by these robots are large and reasonably 
heavy. Also, it Is usually necessary for the manipulator to have a long reach. AS 
a consequence, large point-to-point servo-controlled robots (either hydraulically 
or electrically actuated) such as those produced by Cincinnati Milacron (i.e., the 
73-566), Yaskawa (i.¢., the Motoman L3), or General Motors Fanuck (GMF) at 
normally used for this purpose. The automobile industry is a heavy use! of m 
type of robot (see Figure 1.9.1). Since the weld points are pretaught, sensory 
a e currently 
*There are, in! 
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Figure 1.9.1. A PUMA 700 series robot performing a spot welding operation on 
an automobile part. (Courtesy of Unimation, Inc., a Westinghouse Company, 
Danbury, CT.) 


information is generally not required in order to energize the welding gun. It is, 
however, possible to utilize the increased motor current that results when the tool 
makes contact with the part to initiate the welding operation. 

The second type of welding application, arc welding, is also utilized extensively 
by the auto industry. Here, an often irregularly shaped seam or a wide joint must 
be made. In this case, a continuous-path servo-controlled robot that is often 
specifically designed for this single application is most usually the choice (e.g., the 
Unimation Apprentice robot). If the parts to be welded can be accurately posi- 
tioned and held in place, the complex three-dimensional path can be pretaught and 
no external sensors may be necessary. At present, a number of manufacturers 
include a position sensor that is placed in front of the welding tool and can therefore 
provide information concerning irregularities in the weld path. Several manufac- 
turers provide additional sensory feedback, among them Automatix and GE. Where 
a wide joint is to be handled, the robot can be programmed to produce a weave 
type of motion. This ensures that the weld covers the entire gap. A major ad- 
vantage of a robotic welder is that the arc time (a critical parameter in determining 
the weld’s strength) can be carefully controlled. 


1.9.1.2 Spray painting 


The spray-painting operation is one that human beings should not perform, 
both because of the potential fire hazard and the fact that a fine mist of paint (both 
lead and modern plastic based) is carcinogenic. As such, this task is a natural 
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Figure 1.9.2. Spray painting application at a GM plant in Baltimore, MD. (Used 
with permission from General Motors Corporation, Detroit, MI.) 


application for a robot and so it is not surprising that there are a large number of 
manipulators that perform only this particular job. Another advantage in using 
a robot for spray painting is that the resultant coating will be far more uniform 
than a human being could ever produce. This results in a higher-quality product, 
less reworking of parts, and considerably less paint being used (reductions of 40% 
are often achieved). Robots employed for this purpose are usually capable of 
performing both straight-line and continuous-path motions (see Figure 1.9.2). 

Programming a spray-painting robot is usually performed by the best human 
operator. His actions are then mimicked by one or more robots. The spray- 
painting application generally does not require the use of external sensors. How: 
ever, it 1s necessary that the part to be painted be accurately presented to the 
manipulator. 


1.9.1.3 Grinding 


As a result of arc welding two pieces of metal, a bead is formed at the sea” 
Where a smooth surface is required for appearance sake (such as on auto bodies) 
or for functionality (e.g., to maintain necessary tolerance of parts), it 1s usually 
necessary to perform a grinding Operation. This is also a natural en for a robo! 
since the manipulator can use the same program that was employed in the a 
welding operation. All that must be done is to remove the weldi ’ ni and replat 
it with a rotary grinder (see Figure 1.9.3). ities 

Another important grinding task is on metal cast; Here the robot !§ 
taught the correct shape of the casting using couitinacus ath sapiens ° 
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Figure 1.9.3. Robot used to perform a grinding operation. Depicted here is the 
smoothing of the top part of large heat sinks. (Courtesy of Unimation, Inc., a 
Westinghouse Company, Danbury, CT.) 


grinder then removes any undesired high spots and corrects areas of the casting 
that are too large. A third robotic grinding application is that of deburring. Here 
the unwanted material that remains around the back side of a drilled hole is ground 
away to leave a smooth surface. For increased productivity, it is especially im- 
portant to be able to perform this task automatically after the holes have been 
drilled automatically (perhaps by a robot). 

In these grinding applications, there is always some uncertainty in the di- 
mensions of the part being worked on. As a result, sensory information is often 
needed to permit the robot to more accurately “‘feel” the actual contour of the 
part. This is especially important in the case of smoothing of the arc weld bead. 
Relatively simple touch sensors that provide this information are currently avail- 
able. For example, the Swedish company ASEA uses such a sensor with its IRB- 
60 robot. 


1.9.1.4 Other applications involving a rotary tool 


In addition to the rotary grinding or deburring applications, robots are also 
currently used for drilling holes, routing, polishing, nut running, and driving of 
screws. In the first two cases, preprogramming of either points or paths can be 
performed when extreme accuracy is not required. However, where exact place- 
ment of drilled holes is needed (e.g., in the structural components of aircraft), it 
may be necessary to utilize a template (see Figure 1.9.4). The difficulty with doing 
this is that unless the robot wrist has some ‘‘give” (i.e., compliance), any misa- 
lignment of either the part or the robot itself will result in a damaged template 
and/or an inaccurately placed hole. This problem is overcome by means of a 
compliant wrist which permits the drill bit to be aligned in the template hole even 
if there is a positional error. The remote-centered compliance (RCC) has been 
used for this purpose and is discussed more fully in Chapter 3 (see Figure 1.9.5). 
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Figure 1.9.4. A Cincinnati Milacron T? robot drilling holes in an aircraft wing. 
(Courtesy J. Coshnitzke, of Cincinnati Milacron, Cincinnati, OH.) 


1.9.1.5 Parts handling/transfer 


The simple task of moving a part or object from one location to another 
within the work area is one of the most common applications for robots today 
Often, it is necessary to acquire a part from a remote location and to place it ii 
compartmentalized (e.g., a rectangular array) box or carton (see Figure 1.9.6), 
Once all the compartments are filled, the box is moved (by either the same robot 
or a larger one) to another location within the work cell, where it is sealed and 
stacked for future use. Such an operation is referred to as palletization. The 
inverse operation of unloading an array of objects and placing them in another 
place within the work space (e.g., on a conveyor belt) is called depalletization. 
Since cartons of parts are often stacked one on top of the other, it is necessary to 
teach a vertical offset to the pallet points so that the robot can unload objects in 
boxes that are under the topmost one. Some robots have languages that make 
this a relatively easy programming task (e.g., Unimation’s Puma series utilizes 
VAL II, which permits such an offset to be accomplished with a single program 
statement). Others, such as the U.S. Robots’ Maker 110/2, allow the user © 
program the offsets via the teach pendant. 

Other important parts-handling applications involve the acquiring of blank 
or unfinished parts and feeding them into some type of machine tool for finishiné 
(e.g., a punch press). This application is often a dangerous one for human beings 
and so is ideally suited for a robot. 

Similarly, in the metalworking industries, a common task is to produce 
ished castings or extrusions. Such work can be dangerous since it 1s necessary !" 
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Figure 1.9.5. A Remote Centered Compliance (RCC): (a) variety of actual units; 
(b) problem misalignment in a peg insertion operation; (c) with an RCC, the lateral 
force generated by such a misalignment causes the peg to translate horizontally 
thereby producing a successful insertion; (d) actual motion of an RCC under such 
a misalignment condition. (Courtesy J. Rebman and Lord Corp., Cary, NC.) 


a human being to work in the vicinity of hot furnaces, punch presses, lathes, and/ 
or drill presses. Robots are ideally suited for this type of job because they can 
resist the high-temperature environment and can be programmed to avoid collision 
with the various other machine tools present in the work cell. As an example, 
consider a portion of the automated workstation for forging airfoils shown in Figure 
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Figure 1.9.6. A United States Robots, Inc., Maker 100 is used to perform a 
palletization operation. The shampoo bottles are first filled and then the robot 
places eleven of them into a compartmentalized carton. (Courtesy of G. Heath- 
erston and U.S. Robots, Inc., a Square D Company.) 


1.9.7. It is seen that two simple and small cylindrical pick-and-place robots R! 
and R2 (e.g., both Auto-Place Series 50 manipulators) and one larger spherical 
coordinate robot (a Unimate 1005, for example) are used in this application. 
vibratory feeder mechanism deposits an unfinished (i.e., uncoated) steel slug @ 
point A. R1 acquires the part and places it at location B where a coat of lubricant 
is applied automatically. This treated part is then indexed to C , where R1 1s again 
used this time to place it on a drying turntable at D. When the slug reaches E. 
it is dry and the Unimate uses its long linear reach to grasp the part and place I 
on the furnace turntable at F. The softening process is completed at G and the 
Unimate again reaches into the hot furnace to pick up the heated slug and plac 
it into the extrusion die on the press table at H. The work cell controller se™* 
this and causes the press to be activated. This part of the forging proces IS 
completed when R2 first positions the die for lubrication and then places the finishe? 
extrusions in a bin or on a conveyor. 
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Figure 1.9.7. Several robots being employed in an automated airfoil forging work- 
station. The large one, a Unimate, is a 1005 and is used to move the parts into 
and out of the furnace. The two smaller manipulators, Auto-Place series 50 pick- 
and-place units, move the parts variously from the feeder to a coating station and 
finally to a conveyor Or finished parts bin. (From J. M. Perkins, “Three Robot 
Extrusion Workstation,” Robots VI Conference, Paper MS82-132, Detroit, MI, 
March 24, 1982. Redrawn with permission of the author.) 


1.9.1.6 Assembly operations 


Human beings are capable of assembling a group of diverse parts to produce 
either a finished product or a subassembly because of their ability to utilize good 
eye-hand coordination in conjunction with the important sense of touch. How- 
ever, these jobs may be extremely tedious because of their repetitious nature. As 
such, assembly operations represent an attractive application of robots. For ex- 
ample, consider the assembly of smoke detectors shown in Figure 1.9.8. Here, 
although not shown, a group of servo-controlled robots (e.g., U.S. Robots’ Maker 
0) is actually used. First, the finished printed circuit board is acquired and then 
iS loaded into the bottom portion of the plastic case. Next, a 9-volt battery (with 
's terminals reversed to increase shelf life) is inserted into the battery compartment. 
Finally, the top portion of the plastic case is placed onto the finished bottom 
mes It should be noted that this last operation also requires that the robot 
— ee pressure so as to ensure proper locking of the two parts of the 
ii ¢ finished detector is then stacked in a carton utilizing a palletizing 


Other assembly applications performed by robots include putting together 
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Figure 1.9.8. The assembling of smoke detectors is accomplished using several 
United States Robots, Inc., Maker 100, five-axis, servo-controlled robots. (Cour- 
tesy of G. Heatherston and U.S. Robots. Inc., a Square D, Company.) 


scissors, pliers, and other simple hand tools, the fabrication of small electric motors. 
and the assembling of electrical plugs and switches. In most of these examples, 
the robot is taught the desired points and the sequence of operations. The only 
external sensory information that is normally utilized is whether Or not a part or 
subassembly is at a particular location within the work cell. (Such an indication 
can be obtained using simple optical interrupters or mechanical switches, as dis- 
cussed in Chapter 5.) 

As mentioned above, some applications depend on the robot wrist being 
compliant. This is especially important in certain assembly operations, for ¢% 
ample, insertion of shafts or rods into small clearance holes or the screwing of 4 
screw into a threaded hole. To prevent the binding and/or bending of the rods 
OF Cross threading of the screws, an RCC js often used between the end effector 
tie — eo pange: Alternatively, force and/or tactile feedback can be 
utilized to provide better external Sensing Capability, thereby permitting the robol 
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ter to any positional errors caused by cither the devices which hold 
to adapt a mn (i.c., “present”’) parts or by the robot itself. However, such sensing 
and/or eee sart, not well developed, so most assembly applications are currently 
is, for the eye that either do not require external sensing or else can be 
geared oa with an RCC device. a , 
serforme ber of assembly applications do not require the u 
A num) tronics assembly). In this case it is necessar 
wrist (€-8-> elec ients (€.g., resistors, capacitors, etc. ) into a printed circuit ( PC) 
ajectronic ne ds on these components are easily bent. extremely accurate 
board. ‘ eel insertion is usually required. Although human beings can per- 
aceme 7 : , } 
ange operations, the work is tedious and repeti 


tious, with the result that 
takes are often made. Thus a robot is a good choi 
mista 


ce for this task. However. 
high degree of accuracy demands that the manipulator be equipped with an 
the hig 


| sensor (€.g., a vision system, see Figure 1.9.9). Although vision periph- 
externa reduce system throughput, it is expected that such applications will 
ora ee common as the cost of vision hardware and software drops and the 
es onan become faster. In fact, this is already happening. 

sy 


se of a compliant 
y to insert a Variety of 


1.9.1.7 Parts sorting 


Often, groups of parts are produced In an unsorted manner either to reduce 

ts or because of tolerance variations inherent in the manutacturing process. 
Rob ts have been used to perform the extremely boring task of sorting such objects 
me washers or O-rings). As seen in Figure 1.9.10 the robot, equipped with an 
appropriately designed gripper, acquires the part from a gravity-feed magazine a 
brings it to a workstation that is equipped with an electronic gaging device. | e 
manipulator places the object over a conically shaped anvil. The center hole or 
inner) diameter of the object is a function of how far down it travels on this anvil. 
The gaging device informs the robot controller as to the correct inner dimension 
value, which causes an appropriate branch in the program to be taken. The part 
is then reacquired and placed in the correct bin. It has been found that because 
of the tedious nature of such gaging operations, human beings often make mistakes. 


In contrast, the robot can perform such tasks faster, for longer periods of time, 
and far more accurately. 


Another less common sortin 


g application involves the use of a vision system. 
A group of parts is 


randomly placed on a conveyor belt. The vision system ; 
placed upstream of the robot and determines the type and orientation of the - 
Passing within the field of view of the camera. This information is passed to the 
robot Controller, which then directs the manipulator to move to the correct pt 
with the appropriate gripper orientation. The robot is then able ot oa : 
acquired object into the correct bin (or onto another conveyor). ad 


icati asti andled 
‘pplication is found in factories where many different castings must be ha 
“-8-, IN the automobile industry). 
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Figure 1.9.9. A vision system is used with an Adept robot to perform printed 
circuit board assembly. (Courtesy of Adept Technology Inc., San Jose, CA.) 


1.9.1.8 Parts inspection 


Robots have been used to inspect finished parts or subassemblies in ordet : 
increase product quality. The automobile industry is an example of a group ° 
companies that is striving to upgrade its product by automating the inspection" 
process. Here, for example, portions of auto bodies can be checked for dime” 


; £ ‘ ap nr P : * D e 
sional] accuracy by placing a special-purpose tool having a large number of mova! 


spring-loaded probes against the part. The distance moved by each probe oe 
a ant by a voltage, for example) can be compared to a predetermined " s 
stored In a computer data base) for a « > erm 

( P a base) for a good” part. This system not only enti 


the rejection of out-of-tolerance parts but also gives an indication of P° 
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Figure 1.9.10. Gaging and sorting of washers. A special vacuum erippe 

robot is used to acquire a washer from the gravity-feed m schtanten a sais 
is then placed on the conical anvil at the electronic gaging station where th — 
of the washer’s hole is determined. This information is sent to the robot's. lameter 
which causes the washer to be reacquired and then placed in the pro ee 
compartmentalized storage unit. Proper bin of the 


problems before they become serious. Vision systems have also been used f 
such inspections, but because of their current high cost, this is not a pa 
occurrence. 

Inspection of electronic devices has also been performed by robots. For 
example, a printed circuit (PC) board often must be checked for missing or im- 
properly drilled holes before the components are placed on the board. Two tech- 
niques can be used to accomplish this. In the first, the robot picks up the board 
and puts it onto a special-purpose jig. Probes extend through properly drilled 
holes and make contact with electrodes on the other side of the board. If all 
rae sh made, the part i good and the robot can place it in the appropriate 
napa i . ah one missing contact, the robot's program branches and causes 
Vicker ieletn te to be placed in the reject bin. The second technique utilizes a 
Cc a F | vat consists of one or more video cameras. The robot places the 

ard on a light table. The pattern of light passing through the drilled holes 
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is sensed by the vision system and c¢ 
The vision system then commands th 
We next consider how robots will (or 


1.9.2 Robot Applications in the Future 


Having gone through the preceding section, the reader was ape Struck b 
least two things. The first was that the current ee ad - is UStrial robo, 
are far from esoteric. In fact, they are, for the most part, re ative y simple. The 
second observation was that most of these applications involved using robots fo, 
tasks previously performed by human beings. AS mentioned earlier, it is expected 
that this will not always be so. The “blinders” will undoubtedly be taken off, with 
the result that non-human-oriented applications will become more the rule than 
the exception. What can we expect along these lines? | 

A number of studies have been made over the last few years which try to 
anticipate some of the new applications of robots. One common thread in these 
studies is that advanced applications will almost always depend on the development 
of sophisticated, dependable, and low-cost external sensors. The ‘“‘deaf, dumb, 
blind, and tactileless” robot of the mid-1980s is limited in its ability to perform 
complex tasks. Thus, unless sensor-based robots are developed, applications wij| 
remain fairly simple. 

As an example, Harmon of Case Western Reserve University identified 25 
separate tasks that either currently require or will require One or more of four 
different types of external sensing capabilities (e.g., simple touch, higher-resolution 
tactile, vision, and simple proximity sensing). As can be seen from Table LJ, 
some of these applications have already been realized and have been described in 
the preceding section. In some instances, the desired sensory needs have also 
been identified. However, to a lesser or greater degree, items 8, 10, 11, 12, 13. 
and 19 all would fall into the category of “futuristic” applications. In Table 1.9.2, 
the technological developments required to fully realize many of these applications 
are given. The reader should observe that very few of the needed developments 
can be achieved by integrating existing technology. In fact, most applications will 
require major technological breakthroughs in order to be sucessfully realized. The 
areas of vision and tactile sensing are two examples of this. 

The medical applications of robots (e.g., routine examinations, surgery, oF 
prosthetics) are certainly many years away from reality. For example, the “siX- 
million-dollar man” will be possible Only with the development of real-time signal- 
processing techniques that permit the desired signals emanating from the brain and 
isa ae bite _— peta Separated from muscle noise so as to control the 
segnecs a ~ “a ae ves saa : = ole pack for such appendages will have 7 

i tina » 6 actile-sensing elements with resolutions P 
proximating those of the human hand (e.g., about 1 mm) will b essary. 

The ability of a robot to Carry Out surgical paysite 5 will 
depend on the development of a Variety of § Procedures or examination 

y of external sensors and real-time compute! 
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9.1 MAJOR SENSORY NEEDS FOR ROBOTIC TASKS 
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Source: Harmon, Leon, D., “Automated Tactile Sensing,” Robot 6 Conference, March 1982, Detroit 


paper MSR82-02, MAP I, p. 26. 


processing techniques. More important, the robot will have to be intelligent in 
order to make rapid decisions based on current sensory information. It is certain 
lat a set of preprogrammed actions will be totally unsatisfactory for such appli- 
ations. This implies that significant advances in artificial (or autonomous) intel- 
pe fhe will be required. It should be noted, however, that a Unimation 
tid a II series 200 robot has already been used during stereotactic neu- 
on : gery [21]. The robot s controller was interfaced to a computerized tomog- 
aphy (CAT) system which determined and outputted the desired points in space 


to which the robot was required to move. 
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FUNCTIONS tai 1980 - 
(Rank ordered for overall estimated difficulty, oe cee 1280) 
Pattern Adaptive midi 
ee . tion softwe ithe 
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11. Prosthetics xX X ip . Xx 51 
2. Medical Exam x X x - Xx 51) 
13. Surgery X X - i X 51) 


- Integrate existing technology 
— Moderate new development 
X Major developments required 


Source: Harmon, Leon D., op. cit., Map III, p. 31. 


Underwater applications of robots will involve prospecting for minerals on 
the floor of the ocean (e.g., nodules of manganese), salvaging of sunken vessels, 
and the repair of ships either at sea or in dry dock. In the latter CaSe, a prototype 
version of a mobile robot that is used to clean barnacles from the sides of ships 
has been built and tested in Dunkerque, France, by Chantiers du Nord et de la 
Méditerranée, a ship-building company (see Figure 1.9.11). This rather remark- 
able tripod 1s capable of moving in either air (i.e., above the waterline) or in water. 
It grips the ship’s sides with both vacuum and magnetic feet, a technique that has 
proven to be reliable. The scrubbing action is produced by a rotating brush 
mounted on the end of a rotary axis arm. Currently, no sensory information 's 
available, so the device acts more like a telecheric rather than an autonomous 
mobile robot. In addition to an underwater application, the Renault Compan) 
has used the device to clean the inside of a large fuel storage tank. Since - 
task is extremely hazardous, this js potentially an excellent application. ner 
a considerable amount of work remains to be done before the robot 1s a 
commercially. A modification of the device (using rectangular, rather than ey 
drical leg geometry) is currently being tested for a window-washing application 
International Robotic Technologies, Inc. (see Figure 1.9.12). _ For 

The military is currently looking at robots for use in a variety of area: 
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Figure 1.9.11. RM3 Marine robot shown climbing a vertical wall in air 
device is also capable of walking under water. 
using magnetic and/or vacuum feet. 
brush. (Courtesy of P. Kroczinski, Int 
ina del Rey, CA.) 


The 
It adheres to the side of a ship 


Its single arm 1s equipped with a scrubbing 
€rnational Robotic Technologies, Inc., Mar- 


example, the air force and navy are both interested in mobile firefighters. These 
devices would be equipped with infrared sensors and could react more quickly than 
people in an emergency and in extremely hazardous situations. Moreover, they 
would be expendable. Other military applications of robots will be on the battle- 
field itself. Although it is not inconceivable that robots might someday be used 
to fight other robots, more realistic short-term applications from the military’s 
point of view would be in the areas of surveillance (e.g., guard and sentry duty) 
mine sweeping, and artillery-loading devices. 
In the latter instance, the concept of two coordinated robots being used on 
" 7 Be iiepile gun platform has been developed. A large manipulator (e.g., a 
. + 4000) would be used to acquire the 200-lb round from a magazine and 
aie ; a the field piece. After firing, a smaller robot would unload the shell 
seas 7 (ne process would be repeated. The impetus for such an application 
. . pm the fact that modern electronic tracking techniques make it relatively 
, Cstroy fixed gun emplacements, thereby putting the lives of soldiers op- 


“ruling nearby in jeopardy. Also, the work of loading and unloading the shells 
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Figure 1.9.12. The International Robotic Technologies, Inc. Building Washing 
Robot. The device can climb up and down the sides of a modern building. Vac- 
uum suction-cup feet permit the robot to adhere to either glass or metal. (Courtesy 
of P. Kroczinski, International Robotic Technologies, Inc., Marina del Rey, CA.) 


~ 


is itself physically demanding and difficult, especially where the ground is wet and 
muddy. It is clear that this type of application would place severe environmental 
constraints on the robots being used. Manipulators capable of operating in such 
hostile environments remain to be developed. 

The application of robots for surveillance and guard duty is not restricted to 
the military, however. For example, power generating plants, oil refineries, and 
other large civilian facilities that are potential targets of terrorist groups are being 
considered as potential users. The robots for these applications would probably 
be mobile (running on wheels, treads, or tracks), equipped with some form of 
vision system and other types of sensors (e.g., infrared), and even have defensive 
and/or offensive capability. In fact, several police forces (e.g., those in New York 
City and in London) have already employed prototypes of this class of robot for 
bomb disposal and for entering a dwelling suspected of harboring armed criminals. 

Having mentioned the electric power industry above, it is interesting to 20 
that a group called the Utilities/Manufacturers-Robotic Users Group (U/M-RUS) 
recently conducted a survey of its members to determine potential uses for robots 
within both fossil fuel and nuclear power plants. The excerpted results of this 
survey are shown in Table 1.9.3 and indicate the extremely wide range of potent" 
uses for robots in this single industry. 

As mentioned in an earlier section of this chapter, a potential futuristic 4?" 
plication of robots would be in the home. Such devices would need to be sma" 
mobile, sensor based, easy to program (or better yet ‘“‘instruct”’), and autonomou> 
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£ 1.9.3 POTENTIAL APPLICATIONS OF ROBOTS IN NUCLEAR AND 
rossil. FUEL POWER PLANTS 
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Ageisting mn test and repair of meters 

cyrveilance of uninhabitable areas of plants during operation 

; ubricating fittings on travelling screens 

Inspection of travelling screens and dams to determine need far maintenance 
Weld tube repairing (both girth and longitudinal) 

| oading Mgso, {trucks 

Inspection of 4 KV bus and compartments in plants 

Valve packing inspection and repair 

Testing of fossil plant asbestos levels in work areas 

Location of air, gas, fuel leaks in unit compartments 

Checking for and capping leaking tubes in tubular air heaters 
Cleaning of condensors 

Inspection of condensors for tube leaks 

Plugging of leaking tubes and recording actions taken 

Hydro station inspection and cleaning of guide rails and leak detection 
Performing corona probe tests in air gap of generators 

Control rod drive removal and installation 

Control rod drive exchange 

Pipe welding 

Inspection of the inner diameter surface of moisture separator inlet line 
Pipe inspection and removal of blocking objects (e.g., tools) 

Sorting of laundry 

Decontamination of respirators 

Sorting and compacting of trash 

Tile scrubbing 

Firefighting 





Source: 1987 U/M-RUG survey. 


Clearly, a significant amount of research in AI, mechanisms, and computers remains 
to be done before a device such as the Heath Hero 1 or the more advanced Hero 
2000 robot can be made to do windows or similar tasks (see Figure 1.9.13). The 
goal of robots taking over most mundane household chores is probably worthy of 
reaching for purely sociological reasons. In addition, it would cause the robot 
industry to “take off” and would probably create a host of new jobs. 

Although we have already discussed the use of robots in the area of electronic 
Essel, there is a definite trend toward manufacturing higher-density PC boards 
" Phares utilization of surface-mounted discrete devices (as opposed to radial 
ne an : —— with chips and leadless chip carriers. As shown in Table 1.9.4, 
assembly ; ° _ mid-1980s must be improved in a number of ways before such 
'ype robots : ee economically. For example, Cartesian and SCARA- 
than those us e developed with accuracy and repeatability that are 50% better 

currently available. In addition, it is necessary for these robots to be 


“duipped with intel; ) ) | Ke 28 | 
information intelligent grippers that provide reliable position and tactile feedback 
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TABLE 1.9.4 CURRENT AND FUTURE ELECTRONIC ASSEMBLY ROBOT 
SPECIFICATIONS 
Specifications Today 1990 

Work area 24 inches x 24 inches 24 inches x 24 inches 

Insertion rate’ 1200/hr 2000/hr 

Number of axes 4 4 | 

Accuracy .002 inch 00] inch 

Repeatability 001 inch 0005 inch 

Minimum component .02 inch .O1 inch 

Spacing | 

Payload 5 Ibs with tooling 5 Ibs with tooling 

End-effector Hard-tooled, chuck, Intelligent grippers with 
turret and some sensing feedback 
intelligent grippers 

Controller Autonomous Supervisory computer 
decentralized download to 
microprocessor and microprocessor 
teach box machine control 

Programming languages Numerous low and high- Hopefully standard high 
level robot level factory 
programming automation operating 
languages systems 

Price (robot and $20K to $150K $20K 

controller) 


‘varies with the number of pins per component 


Source: CEERIS International, Inc., “Flexible Automated Assembly Systems Con- 
figuration and Implementation,” March 1984. 


Another extremely important future use of robots will be as a component in 
a fully automated factory or machine shop. Along these lines, the work at the 
National Bureau of Standards has been mentioned previously. It is expected that 
the flow of raw materials using robots and/or automated mobile carts from the 
warehouse to factory floor, the selection of the proper program to accomplish the 
desired manufacturing task, and the carrying out of this task by the appropriate 
numerically controlled machine tool or more Sophisticated sensor-based industrial 
robot will all be handled by a hierarchical control system. A robot design thal 
could be used for facilitating parts and/or materials acquisition from a storehouse 
in such a control scheme is shown in Figure 1.9.14. Currently under developmen! 
at Temple University in Philadelphia, this novel double-wrist, four-axis mobile 
manipulator (called MOBI, for “mobile biped”) is ¢; 
of walk from one array point to another | 
or a football player running through a course of rub 

Today, most robots must be programmed by 
desired task. However, robot controllers that ti ‘ne with data bas¢ 
or CAD/CAM systems are just now becoming iaduahs. “acd aaaat wi 
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ure 1.9.13. All axes of the Hero 2000 mobile robot are servo-controlled. Au- 


Fig 
(Courtesy of Health/Zenith Educational Sys- 


tonomous operation 1s not possible. 
tems. ) 


permit the user to simulate the work cell, robot, and other machine tools and/or 
parts feeding mechanisms “off-line.” The appropriate robot commands will then 
be easily coordinated with the actions of the other devices operating within the 
work cell itself. In this way, the manufacturing process can be optimized with 
respect to cycle time and throughput. 

_ Our discussion of future robotic applications ends by noting that the Com- 
inittee on Science, Engineering, and Public Policy (COSEPUP), composed of ex- 
perts from industry, academia, and government, gave a series of briefings to a 
number of federal agency directors in the early 1980s. The Committee predicted 
that with the development of sophisticated vision systems, tactile sensors, and 
a techniques/languages, it would be possible to use robots in industries 
at handle soft materials such as leather, foam rubber, and vinyl furniture cOv- 

rings. The ability to handle soft materials might also lead to the development 
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Figure 1.9.14. MOBI, a mobile biped robot. The four-axis device is capable of 
performing a ‘“‘walk” maneuver by first off-loading its gripper or tool (not shown) 
and inserting its free end into an adjacent docking port. The other end of the 
manipulator is then removed from the original docking location. In this manner, 
it can move over an array of docking ports like a rigid slinky. At any location on 
the array, the device can perform operations associated with nonmobile industrial 


robots. 


of robot tailors. Other potential applications would be in the area of package 
delivery services, trash collection, and automobile maintenance and repair. Most 
of these predicted applications still remain to be developed. 


1.10 SUMMARY 


In this fairly detailed, nontechnical introduction, we have attempted to give the 
reader an understanding of what an industrial robot is and what it is not, where !! 
is applicable and where it is not, and finally, how such devices have evolved and 
how they may cause another industrial revolution to occur. In particular, the 
reader has been introduced to most of the terminology associated with these devices 
and has been shown how to categorize them either by geometry of their major 
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“the type of control utilized, In addition to tracing the development of 
axes OF by seally, the economic and sociological consequences of these forms of 

| ‘been discussed. Finally, the current and possible ature appli- 
, woman robots have been presented. PP 
cations paul be apparent from the material contained in this chapter that there 
It ie variety of manipulators and that they can perform a large number of 
Moreover, as vision and tactile sensors are incorporated and the controllers 
“omarter,”” the complexity of these tasks will no doubt increase. Appli- 
at were not originally envisioned and involve more than just replacing a 

an worker with a robot will then be feasible. To be sure. there will be an 
humé n some workers, who, unfortunately will be displaced by these machines. 
‘t is expected that in the longer term, more jobs will be created as new 
d industries are developed as a direct consequence of this new. more 
f automation, the robot. 


fon have 
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|.11 REVIEW QUESTIONS 


Due to the fairly descriptive nature of this chapter, the problems that will be 
‘cluded at the end of subsequent chapters are replaced here by review questions. 
The purpose of these is to help the reader clarify the mostly nontechnical ideas 
presented in this introduction to robots. 


1.1 Discuss the major differences between servo-controlled and non-servo-controlled ro- 
bots. 

1.2 Define the following terms: 

a. Work envelope 

b. Work cell 

c. Tip speed 

d. Coordinated motion 
e. Return on investment 

1.3 Discuss the roles that the major and minor axes of a robot play in positioning a part 
In space. 

1.4 Discuss the differences between fixed and flexible automation. 

1.5 Discuss at least five robotic applications in terms of the type of robot that is best suited 
for the job, the level of external sensory information required, and the repeatability 
of the manipulator demanded by the task. 

1.6 Discuss three methods of “teaching” a robot. 


1.7 The end effector is the single component that ‘“‘personalizes” the robot to a particular 
task. Explain this statement. 


Describe the function of the four basic components of a robot. 
Why is the NASA Space Shuttle robotic arm not a true robot? 


1.8 
1.9 


1.10 Discuss the need for cert 
: ‘no a robot ins 
HID Discuss at least three reasons for using 4 roby 


1.12 Discuss several reasons why robots should 
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Systems Overview of a Robot 


2.0 OBJECTIVES 


In this chapter we define the components of a robot from a systems approach, 
expanding on some of the ideas presented in Chapter 1. Some of the functions 
(and/or features) that a robot should be capable of performing whether alone or 
as part of a more extensive system are described. Upon completion, the reader 
should be able to identify the major system components of a robot and should 
understand the required functionality of a robot and its controller necessary for 
the unit to be properly integrated and utilized in a real-world environment. In 
addition, the reader should have an appreciation for interpreting robot system 
specifications. Specifically, the topics that will be covered are: 


e The basic components of a robot system 
¢ The robot as part of a workcell 

e The functions required of a robot system 
e The specifications of robot systems 


21 MOTIVATION 


The : : © ° « ° 

these eld of robotics draws on a multitude of engineering disciplines. Obviously, 

nea wi mechanical, electrical, and software considerations. However, the in- 
"among these and other disciplines is quite complex. Consider, for ex- 
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ample. some of the design criteria required for a multijointed arm so that jy - 
IS 


capable of moving along a straight path. 


¢ The geometry of the manipulator must be such that it can position its too 
along the path. 

e The required positions (set points*) for the servos that drive each join, 
be generated in real time, usually by a computer. 

e The servo system must be capable of responding to the set points ang “ 
driving each joint so that the tool traces out a straight trajectory (note this 
this is related to bandwidth and linear operation of the servos). 

e The joint actuators (motors) must be sized properly to provide the torques 
needed as the arm moves (note that the inertias reflected into each joint may 
be a function of position). 

e The feedback transducers must have the proper resolution so that the SETV0s 
can control the joint positions within some defined error. 

e The mechanical system itself must meet some predefined degree of Stiffness. 
accuracy, and repeatability. (Thus the proper materials must be chosen fo, 
its construction to meet these requirements. Also, consideration must be 
given to the thermal properties of these materials.) 


Must 


This brief discussion demonstrates the interdisciplinary nature of a robot and 
points out the need for good communication among the various engineers involved 
in the design of a robot system. 

The following sections use a “top-down”’ description of a relatively sophis- 
ticated computer-controlled robot system so as to acquaint the reader with its many 
subsystems or “functional blocks’’ and give some indication of where and why 
interactions among them occur. ) 


2.2 BASIC COMPONENTS OF A ROBOT SYSTEM 


Recall from Chapter | that the four basic components of a robot system are: 


e Manipulator 

e Sensory devices 

e Controller 

e Power conversion unit 


Figure 2.2.1 shows these components connected as a system. It is important to 
note that the sensory devices are spread throughout the system. For example, !" 





*Set points are commands given to 


beans F t $0 
an, a SCrvo system, T EWE . “ust its outpu 
that it coincides with a given set point. he system attempts to adjus 
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Figure 2.2.1. Components of a robot system. 


addition to the TV camera (a visual sensor), each joint contains sensors for position, 
velocity, and/or acceleration. In addition, some of the power conversion hardware 
may be located inside the manipulator. The following discussion defines the func- 
tions and subdivisions of these major components. 


2.2.1 Manipulator 


The manipulator consists of a series of rigid members, called links, connected by 
joints. Motion of a particular joint causes subsequent links attached to it to move. 
The motion of the joint is accomplished by an actuator mechanism. The actuator 
can be connected directly to the next link or through some mechanical transmission 
(in order to produce a torque or speed advantage or “pain”). The manipulator 
ends with a link on which a tool can be mounted. The interface between the last 
link and the tool or end effector is called the tool mounting plate or tool flange. 
The manipulator itself may be thought of as being composed of three divisions: 


* The major linkages 
° mae minor linkages (wrist components) 
° The end effector (gripper or tool) 
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The major linkages are the set of joint—link oe that grossly POSition 
manipulator in space. Usually, they consist of the first three sets (countj 
the base of the robot). The minor linkages are those joints and links ASSOciate 
with the fine positioning of the end effector. They provide the ability €0 Orien, 
the tool mounting plate and subsequently the end effector once the Major linkage, 
8ct it close to the desired position. The end effector, which is mounteg ON the 
tool plate, consists of the particular mechanism needed at the end of the robotic 
arm to perform a particular task. The end effector may be a tool that does 4 
function such as welding or drilling, or it may be some type of gripper if the robot's 
task is to pick up parts and transfer them to another location. A gripper May be 
a simple pneumatically controlled device which opens and closes or a MOTE compley 
SeTvo-controlled unit capable of exerting specified forces, or measuring the par 
within its grasp (i.e., gaging). 


the 
NY fro 


t22 Sensory Devices 


For proper control of the manipulator we must know the state of each jOint, that 
is, its position, velocity, and acceleration. To achieve this, a sensory element must 
be incorporated into the joint—link pair. Sensory devices may monitor Position, 
speed, acceleration or torque. Typically, the sensor is connected to the actuator’s 
Shaft. However, it could also be coupled to the output of the transmission (so 
that monitoring of each joint’s actual position with respect to the two Surrounding 
links is possible). 

Other types of sensors may also be included in a robot system. Figure 2.2.1 
Shows a TV camera which is part of a vision system. For the purpose of our 
discussion, this sensor, along with its associated electronics and control, is used to 
locate a particular object in its field of view. Once found, it relays the coordinates 
of the object to the robot’s controller so that the robot can position its gripper 
over the object in order to pick it up. 

Not to be excluded are numerous other types of sensors, such as those as- 
sociated with touch (tactile sensors) and ranging (sonic or optical-type devices). 


These sensors can also be used by the robot system to gain information about itself 
or its environment. 


2.2.3 Controller 
The controller provides the “intelligence” t 


the manner described by its trainer (i.e... 
consists of: 


O cause the manipulator to perform in 
the user). Essentially, the controller 


e A memory to store data definin 
lengths associated with the join 
information related to the prope 


g the positions (i.e., such as the angles and 
ts) of where the arm is to move and othet 
F sequencing of the system (i654 program). 
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: } rprets the dats 
gequence! that interprets the data stored in memory 


1. € and then Utilizes , 
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information from the vision system) into the Sequencer 
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Ap interface to transfer sequencer information to the power conve 
_ that actuators can eventually cause the joints 


each jot, 


| rsion unt 
{Oo move in the desired man. 


ner, 
An interface to ancillary equipment. The robot's controlle 
nized with other external units or control devices (e€.g.. moto 
activated valves) and/or determine the state of sensors such 
located in these devices. 


Some sort of control unit for the trainer (or Operator) to use in order to 
demonstrate positions or points, define the sequence of operations, and con- 
trol the robot. These can take on the form of a dedicated control panel with 
fixed function controls, a terminal and programming language, and/or a “teach 
pendant” or similar device containing ‘‘menu”’-driven instructions with which 
the operator can train the robot. 


r can be synchro- 
rs and electrically 
as limit switches 


2.2.4 Power Conversion Unit 


The power conversion unit contains the components necessary to take a signal 
from the sequencer (either digital or low-level analog) and convert it into a mean- 
ingful power level so that the actuators can move. As an example, this element 
would consist of electronic power amplifiers and power supplies for electric robots. 
while in the case of hydraulic drives, it would consist of a compressor and control 


valves. 
2.2.5 An Implementation of a Robot Controller 


Figure 2.2.2 shows the details of the four major components of a robot system 
discussed above and their interconnections. Based on this figure, we can propose 
4 number of possible implementations for the robot controller. Figure 2.2.3 shows 
one such configuration. Here a single microprocessor is used as both the sequencer 
and the computational element. The common bus is the link that connects the 
microprocessor, its memory, the vision system, the binary I/O interface, and the 
servo loops. By partitioning the system as shown, only the servo loops have to 
Interface to the sensory data from the joints and provide drive signals to the power 
amplifiers. Also in this implementation, the vision system is self-contained and 
corporates all the necessary hardware and software to perform its function. By 
Jistributing the system, we have removed some of the burden from the sequencer. 
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Subsystems of robot components. 


The real-time clock is used to implement dela 
transfer among the various devices connected to 
so that the servo controllers always sam 
set points at the same instant, thus ensurj 
are discussed further in Chapter 7. 


From Figures 2.2.1 and 2.2.2 we can infer another way to organize and 
describe the components of a robot System. That is: 


ys and to synchronize information 
the bus. It may generate interrups 
ple the joint positions and generate nem 
ng a uniform sample rate. These concepls 


e Manipulator 

e Connecting cable 
e Controller cabinet 
e Operator controls 
e External sensors 
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Figure 2.2.3. Possible implementation of a robot controller. 


As opposed to the functionality approach just described, this organization 1s 
based on the physical packaging of the components and as a matter of fact, most 
industrial robots are packaged this way. Clearly, such a description Is not as 

‘ningful to the user in terms of the functionality of each subunit. However, 1t 
-he advantage of corresponding directly to the actual pieces of hardware. 


4.3 THE ROBOT SYSTEM IN AN APPLICATION 


By itself, a robot system has limited utility. Normally, it must be — = 
Other components so that it can be programmed or trained to do some use a mae 
he term “workcell” is used to describe a collection of —— eal on 
trols dedicated to performing one or more specific tasks. ; Paes art feeders 
“ontain several robots in addition to fixed automation devices Oe a voliets) or 
and Conveyors), control devices (6.8. computers Or programmable CO ’ 
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Other devices. such as machine tools. In a typical manufacturing Process, a Da 
Or subassembl through many different workcells before it is finish " 
y may pass ; ed 

In the case of a workcell, once its function is defined and all the componen; 
of the system are identified, installed, and operational, the bedeaae is essential, 
fixed. Even though we define robots as ‘“‘flexible automation” devices, ONCE the 
become part of a system, they act as ‘“‘fixed automation” devices. That is, the 
operations the robots perform will not change until there is a revision of the Original 
process or they are used in a new application. In either case, the application, 
engineer may easily alter the part of the process performed by the robot by re. 
training it and if necessary, changing its end-of-arm tooling. 

Based on the flexible automation concept, using a robot for a given application 
reduces the time needed to procure equipment and the setup time required fo; a 
revision or change in the process. Recall that the robot is an off-the-shelf com. 
ponent, and one does not have to wait for the design and fabrication of a Specific 
machine. Additionally, robots may be considered very versatile since they can 
easily be retrained. This idealized versatility may make the use of a robot attractive 
for short runs since one piece of equipment (i.e., the robot) can be used in place 
of many fixed-cycle machines. Of course, we must recognize that this “utopian 
machine” also has its limitations and. as in most applications today, the majority 
of the “‘cost” (whether dollars, design time, or setup time) is in the end-effector 
tooling and parts-handling devices. 

The “‘intelligence’’ and flexibility of a robot may reduce the need for other 
equipment or controllers in the workcell. For example, by using a robot to transfer 
a part, the need to have that part oriented for pickup in a specific way may be 
eliminated. The robot may be able to adapt to this situation by the use of a vision 
system or by moving the part around until it is properly seated in the gripper. 
These approaches might eliminate the cost of a part orientation station (imple- 
mented in fixed automation). Of course, there may be a time penalty by not 
having oriented parts, but this trade-off must be weighed against the cost of the 
parts orientation station and quick implementation. 

Regardless of the specifics of the application, one may view the robot in one 
of two ways: 


e As the cell controller 
e As a peripheral device 


By examining a robot in a workcell (either as the controller or asa peripheral) 
we shall begin to see the required functionality and requirements of a general robot 
system. 


2.3.1 The Robot as a Cell Controller 


Figure 2.3.1 shows an application in which the robot is the cell controller. 11 this 
case, the robot controls the activity and senses the states of the three convey 
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Figure 2.3.1. The robot as a cell controller. 


belts and also kee 
Here the robot t 
Places it into one 
(C3), @ 
C3 until 
The part 


ps track of any exceptions (or errors) that occur in the process. 
akes a part from either of the input conveyors (C1 or C2) and 
of the nine compartments in the carton on the output conveyor 
nce a carton is filled, the robot controller activates the drive system of 
i hep carton is at the correct location. It then stops this conveyor. 
robot must wait “ee C2 arrive at random times (i.e., asynchronously). Thus the 
can take the ore it receives a signal indicating that a part is present before it 
lo the signal ate and put it into a compartment in the carton on C3. In addition 
Controller sleet that a part is present, an additional signal informs the robot 
iN, While na Cr it Is a good or a bad part. Bad ones are placed in the reject 
UtpUut conve cia are placed in the next available location in the carton on the 
NE rejecy bin - Besides moving the robot to either of the two pickup points, 

One of the compartments of a carton, the controller must be 


ale : ; 
gh to do all of the decision and control functions previously 


d enoy 
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described (such as activating the conveyor and deciding what to do with a B00 
0 


a bad part). 


2.3.2 The Robot as a Peripheral Device 


Figure 2.3.2 shows the same application as that re in the Precedin Sect; 

with the exception that the robot is now considered to be a peripheral device a 
cell controller instructs the robot what to do and when to do it. The robo 
used in Figure 2.3.2 does not have to be as sophisticated as the one shown in Figy 

2.3.1 because the cell controller is making the decisions and controlling the non 
veyors. The cell controller may be a minicomputer, a programmable controller 
Or even a dedicated microprocessor. In this case, the only requirements 


he 
t SYStem 


; Of the 
robot are that it be able to go to either pickup point, to the reject bin, or to ite 
of the nine carton compartments as commanded by the cell controller. |, fact 


this controller may also be charged with keeping statistics on how many rejects 
occur from each line and how many boxes are filled per hour (on the average) 
This last set of tasks would usually not be associated with the control capability 
generally available with most robots. . 


2.3.3 Defining Robot Positions 


In the systems shown in Figures 2.3.1 and 2.3.2, the robot was required to move 
to various positions in the workcell. These positions may be defined in a number 
of ways. For the most simple robot controller, the points are demonstrated; that 
is, the robot is moved to the positions it will be required to go to, and data 
corresponding to the positions of the joints are saved in memory. This processis 
referred to as teaching. Another method which requires a more sophisticated 
controller would make use of a physical layout of the workcell drawn to scale. 
The coordinates of the pickup points and box are entered into the controller and 
are used to determine the positions of each joint for the appropriate location in 
space. If this approach is used, the robot system must be accurate; otherwise, the 
positions attained by the manipulator may not be close enough (i.e., within a usable 
tolerance) to pick up a part. As may be inferred, the accuracy will depend on 
such factors as the resolution of the position-measuring device, stiffness of the 
mechanisms, computational errors, and thermal cvefficients, to name 4 few. 


2.4 FUNCTIONS OF A ROBOT SYSTEM 


Section 2.3 identified some of the requirements of a robot system when use 
other equipment in an application. Based on this discussion and some co td 
associated with automated process control and machinery, we will now pres ‘ot 
list of the attributes that we would like to have ina salvst epelett to facilitat© 
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Figure 2.3.2. The robot as a peripheral device. 


Part Present 
Good/Bad 


the training (programming) of the robot and its use with = fae ae 
addition, some features of the manipulator will also be on the architecture and 
these features and capabilities have a visible impact on " abilities are desirable: 
complexity of arobot system. In particular, the following Cap 


| ch the Robot Is to Go 
Ability to Define Points (or Locations) in Space to Whic | ee 
o a particular point and then 


¢ Demonstration (trainer moves the robot t 
this location) 

¢ Computation (controller comp 
to the new location, e.g., | ™0 


nt location 
utes offset distances from the curre 


ve forward 3.6 inches 
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© Interfacing to external sensors that define locations to which the robot sh 
position itself; for example. 1 order to acquire 4 part (VISION interface 

e Accepting off-line data (¢.2.. from a CAD/CAM system) which define 


Poin 
- 
the robot is to move to as part of its program sequence 


Ability to Move between Points in Various Ways 


© Joint interpolated (all joints start and stop at the same time). This js Ome. 
times called coordinated motion. 

e Straight line (tool tip moves in a straight line while maintaining the same too 
onentation). 

e Continuous path (tool tip passes as close as possible to a Series of taught o, 
computed points while maintaining a constant velocity). 

¢ Contouring (ability to draw circles or arcs, or MOve along a specified curve) 

e Path profile specified whereby the acceleration, deceleration, and speed can 
be selected. 
Program Control 


e Delay before the next instruction 1s executed 
e Ability to set, increment, or decrement counters OF registers 


e Ability to test the numeric condition of registers and branch to an instruction 
based on the result of the test 


e Ability to display data (register values or positions) 


e Ability to input data (for loop control, e.g., perform the same subroutine 20 
times since 20 parts are present) 


e Subroutine capability so that previously taught programs can be utilized in 
other larger programs 


Control for the End Effector 


e Command to open or close (simple pneumatic ‘“‘bang-bang”’-type gripper) 
e Close or open a certain distance (position servo-controlled gripper) 
e Close exerting a certain force (force servo-controlled gripper) 


Provide Interfaces to Ancillary Equipment Such As Parts Feeders, Other Robots, 


and/or Vision Systems 


e Interface via binary inputs and outputs so as to permit use of simple sensors. 
or turn-on OF turn-off ancillary equipment. Typically, the interface should 
provide for various types of voltage levels (i.e., ac, dc, 24, 120, 240V, etc.). 


This interface may also be used to provide handshaking* between the robot 
controller and the cell controller or even another robot 





alt. Po S- ee en e — ‘ 
Handshaking ts a technique whereby two or more systems exchange information to coordinate 


operations. 


sec. 2." 
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terface via serial link. This reduces the Number of ; 
[nterte art - | OF int 
nits communications lo Other devices usin Standard | COMNects and per- 
sts. Typically, this interface Would be USed to tale erial “OMMUnIcations 
i soils types of software Protocols are 0a 7 
a 4 


NeCEssary for may computer 
exibili 
external Robot Control and Communicat; tity. 


aximum {| 
Ons 

Remote specification of which Program the Controller is to Aan | 
-ation of When execution is completed. ‘P fie Provides th. and an ind)- 
controller” to tell the robot what to do, 0 
Remote control lor safety features S the Provisions ¢ 
(regardless of what it is doing) or completely remove re 
The ability to interface the robot With a facto 

as GM's MAP (Manufacturing Automation 
ductor Equipment and Mater 
Communication Standard). 


Housekeeping Features 


Being able to store, retrieve, and delete Program and point data 

Having editing capabilities (such as Inserting or deleting Program steps, re- 
teaching a point, etc.) 

Specifying which program is to run 

Providing statistics for use by 
required for a program, how 
date on which a particular pro 


the trainer, such as 
much mass storage sp 
gram was created 
Program Debug and Simulation 


how much memory is 
ace is available, or the 


Debugging facilities (such as single step and back step) 
Ability to run a 


program but to ignore input signals and/or prevent outputs 
from occurring 
Ability to get a trace of which inst 
Ability to set “breakpoints” 
Ability to check the state of t 
Ability to set the state of out 


System Parameters 


ructions or steps were executed 


he inputs without running a program 
puts outside program control 


Reliable Calibrat 
Positions can 
of absolutely 
Ability to mo 


ion method, so that when power is removed, the same joint 


be obtained when the system is restarted. This implies a way 
defining each joint angle. 


; d 
ve back to a point (i.e., one previously shown or demonstrate 
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to the manipulator) within a certain error. A measure of this is Called », 
eatability. : 

e rene ‘3 move to a computed point (never before attained) within g 
absolute error. A measure of this is called accuracy. | 

e Ability to follow a curve or move in a straight line within some known erro, 
envelope. ' ; 

¢ Definition of payload versus performance (i.¢., Maximum Motion speeq te 
acceleration with a certain payload). 

¢ Definition of ‘settling time” versus speed and payload (e.g. , how long It takes 
the loaded tool to reach the desired location with a specified maximum . 
ceptable deviation about this point). 


“Tain 


Serviceability 


e Ease of maintenance of the manipulator (change of actuators, links, Sensors 
cfc.) 

e Run-time diagnostics (to monitor that the system 1s operating Properly, pin. 
point general errors, and immediately stop the robot if a detectable error 
occurs, such as the jamming of an axis or loss of some functionality of the 
controller) 


e Invoked self-diagnostics (to pinpoint faulty components, subassemblies. o, 
subsystems easily) 


From this list we observe that a robot system can be quite complicated. 
Besides acting as a sequencer to guide the manipulator through some predefined 
activity, it may be sophisticated enough to be able to alter its program sequence 
or performance in real time as dictated by its environment. That is, the robot 
must have the capability to interface to the world around it, either through the use 
of simple binary sensors or by a more complicated scheme such as vision. 

Unlike fixed automation, its sequence of operations may be altered by its 
trainer or programmer. Since the sequence can be modified, provisions must exist 
to make the changes relatively simply. One possible approach is the use of a 
robot-specific programming language (Chapter 7 discusses some robot program- 
ming languages). Another consideration, which Stems from the ‘“‘flexible auto- 
mation” concept, is that since the robot system may be easily reprogrammed, the 
designers cannot anticipate all the possible permutations of how the device will be 
used or even what it will be asked to carry. Thus specifications must be given 9° 
that the applications engineer or user can successfully predict what a particular 
robot system can and cannot do without a costly trial-and-error procedure. 

Not all the features identified above are implemented in every robot co” 
troller. Certain subsets may be chosen to make a simpler or more ‘“‘cost-effectlV¢ 


implementation, Regardless of its features, the bottom line for the successful us 
of a robot depends on: 
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9,5 specif . 
Sec: Mecting performance specifications 
Reliability - 
® Maintainablltty 
Reliability is sometimes measured as “mean time between failures” (MTBF), 


“stainability is indicated by “mean time to repair” (MTTR), 
and main vith a trade-off among cost, sophistication, ease of use. 
aie face market demand. A robot must be a relatively cost-ef 
‘bility: an facturing problem; otherwise, its use may not be justif 
toa " jtomation or human labor. A robot having the most innovative controller 
to fixed a ming language which is mechanically unreliable becomes nothing more 


rogram 
ett ee expensive laboratory toy. 
t 


Manufacturers 
Salability, flex- 
fective solution 
lable compared 


05 spECIFICATIONS OF ROBOT SYSTEMS 

Having identified how a robot system may be used in a workcell and some of the 
features and functions that it requires to be useful, we will now examine the 
specifications that are typically used to describe commercial robots. Appendix A 
shows some of the commercially available robots and a list of specifications as 
supplied by their manufacturers. It should be noted that since there are currently 
no standards in the robot industry, the definitions used by different manufacturers 
may vary considerably. One manutfacturer’s method of measuring a parameter 
may be completely different from another’s. Take, for example, the measurement 
of repeatability or settling time. Ifa noncontact sensor measurement is compared 
to that made with a contact sensor in determining the final location of a robot's 
tool tip, different results will occur. The contact sensor can actually damp out 
oscillations and may impose a force that the robot must overcome. On the other 
hand, the noncontact sensor does not disturb the arm dynamics. In addition, since 
manufacturers are constantly improving their systems, the same systems may per- 
form differently depending on when they were produced. 

The following discussion will attempt to define the questions that a potential 
user should ask when trying to decipher and compare the specifications supplied 
by robot vendors. The specifications follow the order listed in Appendix A. 

The load-carrying capacity or payload specification does not define the ad- 
ditional weight that the manipulator can carry above the weight of its end effector 
or tool. Thus, when designing an application, both the weight of the tool and any 
parts it may carry must be considered since together they constitute the payload 
re seen by the robot. In addition, this specification does not define the shape of 
nena or payload. Two grippers weighing the same may guthnee an 
~ ne . he robot may be able to perform satisfactorily using one contiguratio 

€ other. It is important for the user to know what the maximum inertia 
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about each of the end effector axes is for 4 scaler iatapan : he reason for th 
° . . , > > y 2 ” ats ° t- 
is that since inertia affects the torque required during acceleration, jx yi 
possible to carry a larger inertial load if the acceleration 1s reduced. a. 


The repeatability of a robot should not be confused with accuracy (see Cha 
3). It is a measure of the ability of a manipulator to return to a POSition in Rang 
Where it had been previously. It is measured by going to that position jp exacn 
the same way (i.c., over the same path, with the same payload, speed, aCceleratio. 
temperature, etc.) a number of times. Since most manipulators are designeg ‘ 
be slightly underdamped, so that they oscillate (in a damped manner) somewh., 
about the final position, it is necessary to wait fora short period before repeatabii;,, 
is measured. One must know if the published specifications include a delay. and 
if so, how much. | 

In addition, repeatability may be defined in three-dimensional space. o, on 
a joint-by-joint basis. The actual measurement point Is also important. [¢ the 
measurements were taken at the tool-mounting flange of the manipulator. One 
cannot assume that the tip of a tool or a gripper attached to the mounting flang, 
will have the same repeatability. Depending on the configuration of the Manip. 
ulator, there may also be regions inside the workspace that exhibit different vajye. 
of repeatability. Based on the preceding discussion, it is important to get a clear 
definition of how repeatability is measured by the manufacturer to ensure that the 
specification is properly interpreted. Chapter 3 defines repeatability and its meas. 
urement in more detail. 

The maximum tip speed, no load is an attempt to define how fast the manip. 
ulator can move. As implied by this specification, it will be different if there is a 
payload. In addition, some other questions that arise are: Which joint or joints 
were moving when this measurement was made? Was the motion along a straight 
line? Is it an average value based on distance and time, or is it actually the 
maximum joint speed? 

While we could continue to ask more questions about “‘maximum tip speed.” 
the point to be made is that this number may be nebulous and requires clarification 
by the manufacturer. It should not be used in an attempt to obtain a cycle time 
for a robotic application without the proper inputs from a knowledgeable source. 

The coordinate system specification defines the configuration of the robot. 
In Chapter 1 we provided a detailed discussion of the definitions. Certain con- 
figurations are more useful than others in specific applications, while in other 
instances this specification is of no consequence. 

The maximum movement specification places bounds on the robot’s work: 
space. It is important to note that this is usually measured at the tool-mounting 
flange. In addition, the maximum specifications may imply that some of the joints 
are fixed. Therefore, at the maximum values, it may not be possible to orient oe 
tool in certain positions, The angular movement cited for certain joints may 
defined for physical hard Stops Or positions defined by the controller’s software: 

The type of drives defines the joint actuator’s source of power (€.8-> ae 
hydraulic, or pneumatic). Some applications may require one drive tyP* OF 
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proces” | defines the me | a i 
The control ac ines the method used to control the ax 
and whethet continuous-path Or salidacinaiee cael servoed versus 
tions may require one or more of these aia IS possible. 
lication discussed in Section 2.3. To transfer p ~ For example, 
- requi , | arts fro ) 
‘es aka only point-to-point control. Other he a 
‘ ea of g - , ; . d ‘ 
eee glue, may require the continuous-path Pe Siac 
a complex curve by defining points along it). Other feat ature (so as 
raight-line motion, may be included in this category. UES OUST as 
Memory devices delines both internal memory types and mass stor 
licitly indicated is what happens to the robot oe eae ee 
program if power 


abilities: Not exp 
is remove from the conten Is there a battery backup, or must the user rel 

on mass storag® for program integrity? r rely 

Program! hod defines the type of robot training via a keyboard, teach 


ning met 
endant, walk-t case of painting robots), mechanical setup (for 


hrough (in the 
nonservo units), OF CAD/CAM (off-line programming). 
Memory capacity gives a 


| n indication of the number of program steps or points 
that the robot controller (without mass storage) can handle. Typically, each po- 
sition tO which the manipulator moves requires a step. If I/O is used, it may be 
included in the same step OF require another step. Also, some computer-controlled 
robots do not define their memory requirements in the same way. Thus it Is 
important to have a clear understanding of what this specification truly means and 
the limitations it may impose. 

The remaining categories indicate potential or proven applications that the 
robot supplier cites as application examples. One should be aware that certain 
types of robots are more suitable for certain applications than for others. Typically, 

ful in small-parts assembly or machine loading. 
bots to target specific mar- 


spray-painting robots are not use 
In addition, some manufacturers have designed their ro 

ies, which require certain 

high 


kets, such as the electronics OF semiconductor industri 
special characteristics. For example, robots used in these industries require a 


degree of accuracy and a low particle emission. 

What should be apparent from this discussion is that the user must know 
exactly what he or she wants to do with a robot and ask the correct questions of 
the manufacturer to ensure that the robot in question will perform properly. 
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2.6 SUMMARY 
hitecture and use of a robot. 
available 


This chapter presented a systems approach to the archi 
ots ; cifications used to describe commercially 


Additionally, the common spe 
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units Were discussed. Some basic definitions and concepts were presente . 
with the foundation material for the remainder of the book. Np 


2.7 PROBLEMS 


2.1 Investigate the architecture of some commercial robots and their controllers. Com 
the functionality of the commercial units to the general subsystems shown jp Fin ‘ 
re 


22.2. 

2.2 Investigate the actual implementations of some commercial r obots and their contro) 
Discuss the advantages and disadvantages in these implementations (and architect, : 
if one wanted to implement features (such as those listed in Section 2.4) that are ican 
missing. . 

2.3 Investigate the various methods used by commercial robot manufacturers to Progr 
their controllers. Consider software structure, languages or menu systems, dedicate 
controls, and so on. Based on the list of the general features given in Section 24 
define what commands are used to implement these features for one or two commercial 
units. For example, how does one command a PUMA robot to move in a straight [ine 
or how does one command a particular output line to be energized? 

2.4 (Optional) As indicated, specifications are sometimes misleading. To illustrate this 
consider a 3-axis cylindrical coordinate robot with z fixed and @ and r capable of move. 
ment. 

a. If the @ axis is commanded to move a distance of 90° with an acceleration time of 

250 ms, a constant velocity time of 500 ms, and a deceleration time of 100 ms, what 
is the average linear speed of the tip? (That is, consider the distance moved alono 
the circumference of the circle defined by a radius r and traced by the tip.) What 
is the average speed if r is retracted to one-half of its distance (r/2)? 

b. What is the average linear speed for the conditions described in part a if the distance 
is defined by the length of a straight line connecting the initial and terminal points 
instead of using the distance of the circumference? 

. What is the average joint speed (in rad/s)? 

d. Discuss which of these specifications is most useful; most useless; most impressive. 

Consider the answers from the perspective of a robot user, a robot designer, and a 


robot sales engineer. 


c) 
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Components, Dynamics. 
and Modeling 


3.0 OBJECTIVES 


In this chapter we present fundamental mechanic 
of robotics. Besides reviewing important basic 
mechanical components may be connected toget 


In addition, some topics unfamiliar to nonmechanical engineers, such as tor- 
sional resonance and the nonlinearities of physical components, are introduced. 
Finally, real-world components and engineering problems associated with applying 


them to robotic manipulators are discussed. Specifically, the topics that are cov- 
ered include: 


al concepts as related to the field 
theory it shows how elementary 
her to form a system. 


e Translational motion 

¢ Rotational motion 

¢ Motion conversion 

¢ The problems with real-world components 
* Modeling of mechanical systems 

® Vibrations 

® Kinematic chains 


© End effectors 


ipulator 
* Resolution, repeatability, and accuracy of a manipu 


© ed : ms 
Forces encountered in moving coordinate syste anipulator 
m 
Lagrangian dynamics as a method of modeling a 
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3.1 MOTIVATION 
As indicated in Chapter 2, the field of robotics draws on a multitude of enginee, 


disciplines. It is evident that mechanical engineering 1s prevalent in the desi 
and control of the manipulator and also in applying the manipulator to Situatig 
in manufacturing such as material transfer. ™ 
When considering the mechanical design aspect of a robot, dynamics. kin 
matics, statics and even styling all play a vital role. Table 3.1.1 shows the a 
tionship between forces and motion and these mechanical design consideration, 
The purpose of this chapter is to provide a review of mechanical engineerin, 
concepts from a systems point of view, directed toward the robotic engineerin 
problem, so that the reader can appreciate the considerations of Table 344 
Additionally, it will introduce topics germane to the mechanics of robot manipu. 
lators. Thus although we do not cover the intricate details of mechanical design 
from a practical implementation standpoint nor do we derive every equation, we 
cover those concepts required for understanding, designing, and applying robots 


TABLE 3.1.1 MECHANICAL DESIGN 
CONSIDERATIONS 













No motion Styling Statics 
Motion Dynamics 


3.2 REVIEW OF ELEMENTARY MECHANICAL CONCEPTS 


In this section we provide a terse overview of mechanical engineering concepts as 
related to the motion of robots. These concepts are used in the remainder of the 
chapter for derivations and also in Chapter 4. 


3.2.1 Translation or Linear Motion 


For our analysis and modeling purposes we will be concerned with rigid bodies. 
During motion, we may examine points on the body. If all the points move in 
lines parallel to one another, we term the motion translational 

In the case of robotic manipulators, certain joints may be constrained to move 
in straight lines. As mentioned in Chapter 1, they are called linear or prismatic 
joints. If one of these joints is considered individually, it may be modeled as @ 
rigid body that moves in translation. Thus a looser definition of translation! 
motion applied toa prismatic joint of a robot is motion along a straight line. *" 
this section we discuss a number of elements associated with linear motion. 
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F(t) 


QQ 
\\ AW UX \\\ 
Figure 3.2.1 Force acting on a body of mass M. 


3.2.1.1 Mass 


Figure 3.2.1 shows a force, F(t), acting ona body of mass M and the associated 
coordinate system. The governing equation of motion developed by Newton is 
given by 


F(t) = M(t) (3.2.1) 


Note that the acceleration () is referenced to the coordinate system as shown. 
It is possible to choose the origin at any convenient location as 
consistent. By using calculus we may write expressions for th 
the velocity (x) of the body as functions of time. 

Equation (3.2.1) is a form of Newton’s law, which states 
sum of the forces acting on a body of mass 
acceleration experienced by the body. 


long as it remains 
€ position (x) and 


that the algebraic 
M is equal to the mass times the 


> FO = Mx(t) (3.2.2) 


[tis important to distinguish between a mass (M) and weight (W). The relationship 
Is 


Y= (3.2.3) 


where g, the 


gravitational constant = 32.2 ft/s? = 9.80 m/s’. Equation (3.2.3) 
Indicates that 


Weight is a measure of the gravitational force acting on a mass. 


3.2.1.2 Springs 


spri near Springs are mechanical elements that “store” potential energy. A 
Pring h 


‘S the property that its displacement from its equilibrium position is pro- 
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F(t) 


Figure 3.2.2 Force-spring System 


portional to the force applied to it. Figure 3.2.2 shows the symbol for Such a 
element, with an applied force and a coordinate system. Note that one end - 
the spring is not free to move; this is considered to be at “ground” (Section 3.5 
covers the case of a spring both ends of which are free to move). The displacemen; 
of the spring is given by | 


F(t) — F, = Kx) (3.2.4) 


where K is the spring constant in units of force/displacement, while F,, represents 
a preload tension, that is, a force required to keep the spring stretched a prescribed 
distance. Under this condition, the spring is displaced from its original equilibrium 
point by a force equal to F,, a new zero for the coordinate System is established, 
and any force in excess of F,, causes a displacement of distance x so that Eq. (3.2.4) 
is satisfied. In practice, springs are not as linear as defined by Eq. (3.2.4). How- 
ever, in the case of small deformations the linear approximation is valid. 


3.2.1.3 Friction 


Translational systems also exhibit friction. Recall that friction is a force that 
Opposes motion. Friction is usually nonlinear and dependent on such factors as 
velocity and pressure between the two moving surfaces and also on the surface 
composition. For analysis friction can be broken down into three distinct com 
ponents [8]: 


e Viscous friction 
e Static friction 
e Coulomb friction 


Viscous Friction. Viscous friction is a retarding force that exhibits 4 linea? 
relationship between the applied force and velocity. A physical component 
produces this relationship is the dashpot. Figure 3 2.3 shows the symbol for : 
dashpot, an applied force, and a coordinate system. The relationship between th 
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mr i). Ft 
Figure 3.2.3) Dashpot and force 
system 
and velocity for this element is given by 
foree ¢ 
F(t) = Bx(t) as 


where B has the units of force/velocity. 


static Friction. Static friction (sometimes called starting friction) prevents 
‘nitial motion. Once motion begins, this force “vanishes.” We will represent this 


friction by the equation 


F(t) = =F (3.2.6) 


The sign will depend on the direction of motion and be such as to oppose the 


motion. F, is the magnitude of the static friction force. 


Coulomb Friction. Coulomb friction (also called running friction) has a con- 
stant amplitude. Its sign is dependent on the direction of the velocity. The 
following equation will be used to represent running friction: 


F(t) = F, sgn (x) (3.2.7) 


where F. is the magnitude of the Coulomb friction and sgn is the signum function. 

Figure 3.2.4 shows velocity versus force characteristics for systems exhibiting 
the frictions mentioned above. Physical systems usually exhibit a combination of 
all three types of friction. Therefore, when estimating the force required to ac- 
celerate a mechanical system, it is necessary to provide force sufficient to overcome 
all the frictional components as well as that required to produce the required 
acccleration. During deceleration, it should be apparent that the frictional com- 
ponents will help to stop the system and a force of less magnitude than given by 
ly. (3.2.1) will be needed. If a constant-velocity portion of the motion exists, 
‘orce will be needed to overcome both Coulomb and viscous components. Ap- 
pendsx B relates this concept to the selection of motors. 

A component used to reduce friction between surfaces is referred to as a 
vearing. Bearings come in both linear (for translational motion) and rotary (for 


MOlary motion) configurations, Many different implementations are possible, each 
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Force 






Force 
Force 






0 Velocity 
0 Velocity 





Static Friction ae Friction 
A= (Fg) |e =F, Sgn(v) 


Viscous Friction 
F(t) = Bx = Bv 


‘ctic for frictional forces. (Benjamin 
Figure 3.2.4 Force versus velocity characteris | 
Ct Kuo, Automatic Control Systems, 5¢, © nl hes 133, 143. Reprinted by 
permission of Prentice Hall, Inc. Englewood Cliffs, 


of which exhibits certain characteristics. Refer to 13] or any other mechanical] 
engineering handbook for a description and classification of bearings. For our 
discussions, it is important to realize that to implement mechanical systems, one 
must ensure that shafts which rotate are supported, or masses that move across 
surface are both constrained to a single degree of freedom and have the minimum 
friction acceptable. The use of bearings is one method of providing this constraint 
while minimizing the friction between the moving member and the surface to which 
its movement is referenced. 


3.2.2 Rotational Motion 


Rotational motion takes place about a fixed axis. For the case of a rigid body, if 
all the points along some line remain fixed during a motion, the body is rotating 
about that line. Since some robotic joints may be rotary (or revolute) in nature, 
they may be individually modeled as a rigid body rotating about some line or axis. 
Dynamical relationships and physical quantities associated with this type of motion 
are directly analogous to those of translational motion. 
Thus linear displacements become angular rotations and are typically meas- 
ured in radians. The moment of inertia, the rotational analog of mass, quantifies 
the property of an element that stores the kinetic energy of rotational motion. 
The moment of inertia is highly dependent on the aecaniele: es f an object 
Torque is analogous to force in a translational system piershage a ve on 
motive action for rotation. Figure 3.2.5 sh _ Pied ee on ei 
ein a shows a torque—inertia system with a 
coordinate system. The equation describing th 2 y we 
by § the dynamics of this system is give? 


a MO) = JO) = Ja(t) 3.2.8) 
where () is the instantaneous tor ” 
> > e . u i s 
body’s moment of inertia through ue angular acceleration, and J the 
ro 


tation. Equation (3.2.8) states 
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Tit) 


Force F(t) 





0° (Reference Position) 


Figure 3.2.8 Torque-inertia system, Figure 3.2.6 £ 


OTque generated by ; 
force acting 


at a distance. 


that if we apply a torque of magnitude T 
J, the body will experience an angular ac 
and (3.2.8). 

Figure 3.2.6 illustrates another way 
force and the perpendicular distance fro 


to a body having 


a moment of inertia, 
celeration of 0. 


Compare Eqs. (3.2.1) 


of defining tor 


que—as the product of 
m the pivot to 


the force vector. The 


» 2 resultant torque may be calculated by 
summing all the torques with the appropriate signs. 


Torsional springs provide a displacement proportional to the apphed torque. 
Figure 3.2.7 sh 


OWS a torque-spring system. The dynamics of this system are 
described by 


2.9) 


oe) 


T(t) = K0(0) 


| beta . This equa- 
he spring constant in units of torque/rotary displacement : 
be compared with Eq. (3.2.4) 
Rotational Sy 
"quations (3.2.10) 
40d Couloy 


Where K ist 
on Should 


i ae anslational systems. 
stems also experience friction similar to ee eee ale 
| (3.2.11), and (3.2.12), respectively, describe ) 

nb friction in rotary systems, 


| (3.2.10) 
T(t) = BO(t) 
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0° (Reference Position) Figure 3.2.7 Torque-spring System. 


T(t) = +Tylg_o (3.241) 


T(t) = T. sgn (8) (3.2.12) 


3.2.2.1 Moment of inertia: calculation 


The computation of the moment of inertia is extremely important in the Sizing 
of motors and in modeling the dynamics of a physical system. As stated in the 
preceding section, the moment of inertia of a body is highly dependent on its shape, 
and unlike mass, is not a unique property of the body but depends on the axis 
about which it is computed. 

Fquation (3.2.13) defines the moment of inertia about an axis for a system 


consisting of n discrete ‘‘point masses”, {M,, M,,... M,}. 

n 

J= > Mr? (3.2.13) 
i=1 

M; 

l23 

M3 
M, 
Vh2 
M, 


Inertia about axis through point masses M;, M2, and M, 


-mass 
which are connected by rigid rods. nt-m 


Figure 3.2.8 Inertia about 4 po 
JSmy = Mz Wy27 + Msg W435? system. 

Sma = My tz? + Ms Fra3* 

Jus = M, Mya” + Mz F237 
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eC. 
here iy. is the mass of point! and r; is the distance of the mass from the axi 
"i i ! san can ‘ . ,Aa ‘ anal Ss: err 
| cation: Figure 3.2.8 shows three point masses and the moments of inerti . . 
“ye 1s Va) + .Y " ‘ 
r massing through each one perpendicular to the plane of the paper ia ahout 
ee ¢ bodies of complex gec | | , 
ymetric shape, Eq. ( 
| , Eq. (3.2.13) become 
: s the 


a : ACP 
For {he case 0 


integral 


j = | or’dV (3.2.14) 


Volume 


is the density of the body’s material, dV is a differential volume ele 

and the integration 18 to be carried over the entire volume of the bod ur 
ase of homogencous bodies (i.e., the density is the same throughout) ’ ma be 
brought outside the integral sign. _— 

Figure 3.2.9 shows some common geometric shapes and the moments of 
about the three centroidal axes shown. Centroidal axes are those passin 
roid or “center of gravity” of the object. Recall from basic shysics 
f gravity of an object is easily determined by balancing the object 
on a ‘knife edge’’ to find its balance point. If this is done for a oni odenichaanl 
object along its length, width, and height (or other coordinate frame), the three 
balance points may be projected into the center of the body to define the actual 
center of gravity. 

The moment of inertia of complex areas and shapes may be evaluated by the 
addition and/or subtraction of elemental areas with respect to the axis of rotation 
For instance, to compute the inertia of a hollow sphere about any one of ts 
centroidal axes, all that is necessary is to subtract the inertia defined by the inner 


radius from that defined by the outer radius. 


_ Parallel Axis Theorem. The parallel axis theorem provides the means of 
finding the moment of inertia of a body about an axis which is parallel to an axis 
that passes through the center of gravity of the body. Mathematically, we have 


J=J,+ Mr (3.2.15) 


where J, is the moment of inertia of the body about the axis passing through its 

eee — (2.54 centroidal axis), M the mass of the body, and r the distance 

is Sarloms A " axes. At this point it should be noted that formulas are tabulated 

arbitrary _ s (see [1]) that allow calculation of the moment of inertia about an 

5 thie ae not parallel toa centroidal axis; however, for purposes 0 
s text, the parallel axis theorem of Eq. (3.2.15) will suffice. 


where P 


C 


inertia 
through the cent 
that the center 0 


f illustration 


EXAMPLE 

MPLE 3.2.1: USE OF PARALLEL AXIS THEOREM 

about an axis at one of its ends 
3.2.9 we know that the moment 
xis through its 


Fy ; 

o the moment of inertia of a slender bar 

shown in Figure 3.2.10, From Figure 
ertia of a slender bar of length / and mass M about an a 
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center is given by 
‘ I 
The center of mass is located in the middle of the bar at 1/2 ang has y 
designated as the y axis in Figure 3.2.9. Therefore, by Eq. (3.2.1 5) we eet 
ain 


Jy = aM + M(l2) 


II 





4MI? 
af [a 
a : 


3 M(3R2+P) | + M(3R2+P) - 


Figure 3.2.9 Centroidal moments of inertia for some common shapes. 
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Slender Bar 
of Mass M 


anon , | Figure 3.2.10 Figure for Example 
3.2.1: use of parallel axis theorem. 
Radius of Gyration. The radius of gyration is the radial distance from any 


given axis at which the mass of the body could be concentrated without altering 
a of the body about the axis. We define the radius of gyration, 


the moment of inertl 
J 
= fe (3.2.18) 


k, by the following equation: 

This equation is a solution of Eq. (3.2.13) for the radius, knowing the mass 
and moment of inertia of the body. It is important to understand that the radius 
of gyration is not the center of gravity of the body. The following example illus- 


trates this concept. 


EXAMPLE 3.2.2: RADIUS OF GYRATION AND CENTER OF GRAVITY 


Compare the center of gravity and the radius of gyration for the moment of 
bout both axes of the rod in Figure 3.2.10. From Example 
of Figure 3.2.10 is at //2 and the 
d end axes are given by Eqs. 
), we compute the 


inertia calculated a 
32.1 we know that the center of gravity 
moments of inertia about the center axes an 
(3.2.16) and (3.2.17), respectively. Using Eq. (3.2.18 
radius of gyration for each axis as follows: 


k, = IVs (3.2.19) 


2.20) define the distance that a point mass 


could be located from each of the indicated axes S® that the same pn 
of inertia would be generated if the bar were rotated about either 0 b “ 
axes. In both cases the radius of gyration ‘5 different than the center 


Equations (3.2.19) and (3 
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Chap, 
Example 3.2.2 can also be used to illustrate a common error used IN co . 
the moment of inertia about an axis. Although Eq. (3.2.13) correctly defines ie 
moment of inertia of a point mass about an axis it cannot always be app; he 
obtain the moment of inertia of a body of arbitrary shape. Consider, for ex 
that we approximate the body as a point mass physically located at its enter.) 
gravity and then use this point to define the distance of the body from its a is - 
rotation. For the case of the rod shown in Figure 3.2.10, if we had useq the... 


, 
of gravity to compute the moment of inertia about the y’ axis, the result Would ‘ 
Jy = aM? 


e 
(3.2,2)) 

Comparing this with the correct result of Eq. (3.2.17) shows that an er; 
25% On the low side has been made. This error could cause serious 
that the payload of a robot may be incorrectly calculated, thereby 
System to be unable to perform adequately. . 

Based on the previous discussions, it should be obvious that t 
approximation of Eq. (3.2.13) should not be used arbitrarily to compute the inert, 
of an object. In some cases this approximation is sufficient. However, one must 
ensure that the error introduced does not produce misleading values. 
conservative approach is to decompose the body into elementary shapes 
in a table of centroidal moments (e.g., those in Figure 3.2.9) and the 


parallel axis theorem [Eq. (3.2. 15)] to compute the inertia of the object in 
Example 3.2.3 illustrates this procedure. 


Or of 
Problems i 


Causing the 


A more 
aS shown 
N use the 
question. 


EXAMPLE 3.2.3: CALCULATION OF INERTIA F ROM ELEMENTARY SHAPES 


Figures 3.2.11 and 3.2.12 show a simplified parallel-jaw type gripper which 
has been modeled by three rectangular parallelepipeds, each consisting of a 
length, width, and height dimension. The density of the material, aluminum, 
is 1.56 oz/in.*. For the particular application being analyzed, the gripper is 
free to rotate about two perpendicular axes (z and y) as shown (i.e., the roll 
and pitch axes). Note that the z axis goes through the center of the gripper, 
while the y axis is some distance from the back surface. For the dimensions 
shown, compute the moment of inertia about both the z and y axes. 

From Figure 3.2.9 we identify the axes associated with each rectangular 
member as shown in the exploded view of t 
The dimensions a, b, and c corres 
and we identify the components 
delineate the members. 


The contribution to the moment of inertia about the z axis is computed 
by first d Ini ‘ects 


h 
z axis. Equations (3.2.22) th moment of in 


three members referenced t 
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Figure 3.2.11 Parallel-jaw gripper model. 
— Lt 
Veron _ 12M top (b? vt c*) + Mop 7 (3.2.22) 
Jo, = TMyo(b? + c2) + Moor 125 (3.2.23) 
J vaae = 2M giae(a? T c*) (3.2.24) 


Note that the parallel axis theorem wa 
contribution from the side member since its c 
with the z axis of the gripper. Therefore, th 
the z axis is given by 


S not needed to compute the 
entroidal y axis was coincident 
€ total moment of inertia about 


Jooar = Jog, + In, + J (3.2.25) 


Zside 


Utilizing the actual dimensions given in Figure 3.2.12 yields 


J... = 0.0252 oz-in.-s? (3.2.26) 


Ztotal 


The moment of inertia about the y axis of the gripper is computed in a 
similar manner. In this case, however, the parallel axis theorem must be 
used for all three members since none of the centroidal axes under consid- 
cration are coincident with the y axis. Equations (3.2.27) through (3.2.29) 
define the moments of inertia due to each plate about the y axis. 


Yop = Mop (a? + 7) + Meop 15: (3.2.27) 
top 
. 2.28 
Jy = Myo, (a2 + Bb?) + Moor Po (3.2.28) 
: M 3.2.29 
Ysi = B side (a? a b*) 7 Ms, ide ae ( ) 
- J (3.2.30) 
Yiotal — UI iicig + : 4 Yside 


2.12 yields 
Again Substituting the dimension values of Figure 3 y 


3.2.31) 
J, = 0.6389 oz-in.-s° ( 
Ip = 0.6389 oz ines 


‘fepow 1oddus mel-joyered ay} Jo Mota popoydxy = zZy'z'¢ ans 
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An interesting trade-off In the design a Manipulate; can be mad 
. moment of inertia seen by the JONt's act ator a © abilit 2 nen 
ware to balance a load Against Bravity, Cong; er, for ex : be the Joint’s 
qactlule : _3 . ’ ‘ QO} 
i, that shown 1n Figure 3.2.6 which AWitational for Joint similar 
( 


IS subject to pr 

saint from rotating downward, the JOint’s dCtuator Must » Prevent 
the J« ot point) which is opposite and equal to the torque 

the eat of a counterbalance Can be useq tor hig rated 
a ald be quite large when the Manipulator jc full i oy 
— using this technique are the 

rouvss 


" WO commercial] 
| AKeT Series from United States R 
he Merlin series from American Robots. 
the 


* Robots and 
Counterbalancing consists of plac: 


ty que required 
€ addition of the COunterweight incr 
ment of inertia about the pivot point. 


Typically, there are two torque paramete 

ing and the root-mean-square 
indication of the maximum value of torque that needs to be pr 
actuator, while the latter indicates how much torque can be produc 


without destroying the actuator (Chapter 4 anq Appendix B deal 


ed continuously 
detail). Thus, in us; 


with this in more 


Small. 
Value o 


I the torque to be provide 
the pea 


k value necessary for acce 


3.2.2.2 Moment of Inertia: measurement 


The moment of inertia of a physical body may be easily ere rn paisa 
4 torsional] Pendulum or q physical pendulum. Figure nr : ai inns tailed 
Pendulum. This arrangement consists of a wire or slender sha The relationship 
CON ch is Suspended an object of unknown ral rovided by the 
Object and shaft is such that the degree a cetaaas the moment 

ugh the axis of the object about which we wish to de 


‘tant from whi 
between the 
Shatt ic thro 
of Nertig. 


1, the 
and then released, 
If the Shaft or wire Is twisted through a small angle a 
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Shaft With 
Known Spring —————— 
Constant iy 
Position 


Object of 
Unknown 
Inertia 


Equilibrium ‘ ; 
Position Figure 3.2.13 Torsional Pendulum 


object will oscillate about its original equilibrium position, The relationship be. 
tween the object’s moment of inertia J, its frequency of oscillation f, and the Spring 
constant of the shaft K is given by 


1 K 
f= al F hertz (3.2.32) 


In the real world the actual spring constant of the shaft may not be known 
with sufficient accuracy to perform a useful measurement. To Overcome this 
problem, the spring constant may be measured by using an object whose moment 
of inertia is known (such as a disk) and measuring its frequency of oscillation in 
the torsional pendulum arrangement. Once K is determined, the moment of inertia 
of any object may easily be found. 

The physical pendulum shown in Figure 3.2.14 is another practical method 
to determine the moment of inertia. In this case, the object is pivoted about a 
fixed axis. An imaginary line (of length h) from the pivot point to the center of 
gravity of the object is drawn. If the object is displaced from its equilibrium 
position, this imaginary line will oscillate about its equilibrium position with 4 
frequency defined by 


_—_lT 


fe - Mgh (3.2.33) 
qT J 


3.2.3 Mechanical Work and Power 


ar at oe 1CS 
Phe concepts of work, energy, and power are essential in describing the dynam” 
of a system and sizing components, The following discussion briefly touches 
these concepts for both linear and rotary motion. 
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Mg Figure 3.2.14 Physical pendulum. 


Work may be defined in terms of a force F acting on a body in such a way 
that the force has a component along the line of motion of its point of application. 
The work done by the force is positive if the force acts in the direction of motion, 
while a negative value of work is obtained if the force is opposite to the direction 
of motion. Based on this definition, it should be apparent that an applied force 
that is perpendicular to the direction of motion does no work. Equation (3.2.34a) 
defines work in terms of a line integral. 


We | F(s) ds (3.2.34a) 


F. is the component of the force along the path and is dependent on its location 
in space; thus it is a function of s. The limits of integration s; and s, define the 
initial and terminal points, and ds is an increment on the path. | 

For the simple case of a constant force in the same direction as the displace- 
ment, Eq. (3.2.34a) may be written as the product of the force and distance: 


w= Fs (3.2.34) 


It can be shown that if a force is imparted to a body of mass M ansenige 
lo accelerate), the work of this force equals the change in the kinetic energy 


3 body. This is expressed by Eq. (3.2.35), which can be derived from Eq. 
9.2,34b) 


22> 
W = $Mv3 - 2Mv; (3.2.35) 


Where v, is the initial velocity and v, is the final velocity of the body. 
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If the effect of gravity is included when w work done by 
resultant force, we may write 


W = (1Mv3 + Mgh,) — GMoz + Mgh,) 8.235 


where W is the work due to all forces acting on the body except for that of gray; 
which has been included in the potential energy terms, and A and h, are the fj »; 
and initial heights of the body with respect to some zero potential ener BY Tefere x 
The first expression in parentheses is the final value of the total mechanica} enerpy, 
and the second is the initial value. | ‘ 

If the body is attached to a linear spring and experiences no change in Potentiay 
energy due to gravity, the work done by the resultant forces on the body (excludin 
that done by the spring, which is expressed as a potential energy) may be Written 
as 


W = (3Mv3 ee +Kx3) — (;Mvi Tr +Kx?) (3.2.37) 


From Equations (3.2.36) and (3.2.37) we note that the work done by an 
external force (excluding gravity or elastic forces of a spring) acting on a body is 
€qual to the sum of the change in the kinetic energy of the body and the change 
in the potential energy of the body. That is, the force must overcome the potentia] 
energy due to gravity and provide force for acceleration. 

Power is defined as the time rate of doing work. Therefore, we may write 


dWw 
oars 


For the case of a force acting in the same direction as the velocity of a body, 
the average power may be defined as the product of the force and the average 
velocity of the body. 


(3.2.38) 


P = FD (3.2.39) 


The bar over the variables in Eq. (3.2.39) defines an average value. 
The instantaneous power is the product of the force and the instantaneous 
velocity: 


P(t) = F(t)v(t) (3.2.40) 


For the case of a frictional element the power is dissipated as heat. Conside' 
the dashpot of Figure 3.2.3. Equation (3.2.5) defines the force that it exerts as 
function of velocity. Assuming a constant velocity acting on the dashpot, u 
average power dissipated as heat is given by 


) 
F dicsiouied = By? (3.2. 


In the case of rotational motion, there are energy relationships that are sim 
to those of the linear case. Work can be defined in terms of torque I, & 
through a given rotational displacement. Thus, if a torque 7, acts througt 

’ ? 
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sec: ° _ 
nk 9 the work performed is given a 
| (3.2.42) 
goth mass and inertia have the ability to store kinetic energy. For the linear 
system we have Por 
hail (3.2.43) 
in xinetic energy of a rotational system is given by 
Ey, = 2Ju? (3.2.44) 
similarly, the equations defining elastic potential energy for a linear spring 
and rorsional spring, respectively, are 
E, = 2Kx* (3.2.45) 
E, = 2K0 (3.2.46) 
Power for a rotational system is defined as the product of torque and angular 


s an equation analogous to Eq. (3.2.40) is 
Pl) = THe (3.2.47) 


velocity. Thu 
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hapter 1, the joints of a robotic manipulator may be rotary or 
linear in nature. The components used to implement a practical joint usually 
consist of an actuator (e.g., motor) coupled to the physical joint by a mechanical 
transmission. This transmission is used to take the actuator motion and direct it 
to the joint in order to provide such characteristics as a change of rotational 
direction, a change of axis, torque multiplication (or reduction), and speed reduc- 
tion (or multiplication). The transmission may be used to convert rotary motion 
o linear motion or to provide a “match” between the actuator and load in order 
that the maximum energy is transferred to the load. Some devices produce linear 
relationships between input and output motions and thus are well suited for use 
in closed-loop control. However, some of the more traditional mechanical schemes 
have highly nonlinear input/output relationships, which can create severe control 
problems. 

We have used the word “transmission” to define all the components from 
the actuator to the physical joint. These components may consist of shaft couplers, 
multiple sets of gears, and lead screws, to name but a few. Although it is possible, 
and very desirable for reasons that will become clear throughout this chapter, 10 
implement a joint by direct drive (i.e., actuator and joint are one component with 
“0 Uansmission), it may be impractical for cost or size reasons. One commercially 
Wailable robot using a direct-drive approach ‘s manufactured by ADEPT (see 
Chapter 4) 


As described in C 
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3.3.1 Rotary-to-Rotary Motion Conversion 


ew 2 ‘ ith such componen 
Rotary-to-rotary conversion is associated with s ponents as pea, tra; 


harmonic drives, belts and pulleys, or sprockets and chains. Each of these ,.S: 
ae : and speed provided by a rotary actuator c ©m. 
ponents will take the torque and sp he output shake On ete 
to the input shaft and provide rotary motion on i r an hea »€Pending = 
the type of component and its characteristics, an a” aa 4) a Shaft mi 
be reversed, have an increased torque (with a reduced speed), or have an iNcrease, 


speed (with a reduced torque). 


3.3.1.1 Ideal gears 


To understand the process of rotary-to-rotary motion conversion, we wil 
focus on the properties of an “ideal” gear train (the concepts developed aTe eagi 
applied to the belt and pulley, or sprocket and chain). By the “ideal gear train’ 
we mean a transmission composed of gears that are perfectly round, rotate ON thei 
true centers, and are also inertialess. The surface between the gears is algo ftic. 
tionless, thereby creating no losses. 

Figure 3.3.1 shows the front and side views of a gear train. Either shaft may 
be designated as the input or output. The top gear has a radius of r, and has N 
teeth, while the bottom gear has a radius of r, and N, teeth. Both gears have , 
rigid shaft attached to them with the torque and displacement of each Shaft des- 
ignated as T and 8, respectively. Note that for the case of two gears shown in 
Figure 3.3.1, the rotation of the shafts is in opposite directions. 

By examining the same physical relationships between the two gears, equa- 
tions relating the speeds, displacements, and torques on the two shafts may be 
obtained. Since the spacing between the teeth on each gear must be the same so 
that they mesh properly, the number of teeth on each gear is proportional to the 
radius of the gear. Thus 


Nr _ 


ry ee) 


(3.3.1 


It should also be apparent that the number of teeth on a gear must be a whole 
number. However, the gear ratio N,/N, may be fractional. 

For the ideal gear train, there are no losses, and therefore the work done by 
the torque acting through an angular displacement on one shaft is equal to the 
torque acting through the corresponding angular displacement of the other shaft 
(see Section 3.2.3). Therefore, 

110, = 7.0, (3.3.2) 


The arc length of the distance traveled by one gear must equal that of the other. 
That is, the distance traveled along the surface of each gear is the same. Converting 
the arc Jength to angular displacement yields 

(3.3.3) 


r,0, = r50, 
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Figure 3.3.1 Ideal gear train with parameters. 


Finally, noting that since the two gear radii do not vary with time, if Eqs. (3.3.2) 
and (3.3.3) are differentiated with respect to time, their relationship still holds but 
with respect to 6 (i.e., the angular velocity w*) or ® (i.e., the angular acceleration, 
a). Using this concept, we may write 


—_—— eee —_——_ — ie 


Ni th _ T, 9 _ ®2 _ %& (3.3.4) 


N, 1 iT, 8 OF 
Equation (3.3.4) can be used to investigate varlous properties of vel ea 
ecar train.” For example, assume that the speed of both shafts “cae that the 
‘he speed of shaft 1 is greater than the speed of shaft 2; then wadition we also 
dumber of teeth on gear 2 is greater than that on gear 1. In adaiiinn, 


— __ . 


Se 


of t ‘Although not shown explicitly, the reader should keep in ml 
Ime, 


nd that w, o, and T are functions 
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know the ratio Nj/N;. Finally. if the torque on shaft 1 is known, we can compu 

the torque on shaft 2 by ; 
1, = 7, N, 

This particular relationship shows the speed reduction and torque Multiplicatio, 

property of a gear train. ae 

A commonly used definition in motion conversion IS that of the coupling rax;. 
Loosely defined, this ratio is the angular movement of the input compared to the 
load. For a rotational system, a coupling ratio of 2:1 defines a gear train in Which 
two turns of the input shaft produce a single rotation of the output. Note that in 
this case the coupling ratio is the inverse of the tooth ratio, TR, which we defin. 
as (N,/N,). 

It is interesting to note that the ideal gear train is similar to the ideal electrica| 
transformer. In fact, one may transform a mechanical system containing a gear 
train into an analogous electrical network containing a transformer. In Section 
3.5.4 we discuss this in more detail. 

Employing the same concepts that were used to develop Eq. (3.3.4), the 
transfer relationship between the input and output shafts of a compound gear train 
(1.e., One consisting of more than two gears) may be derived. 

Gear trains can be used to change ‘“‘mechanical loads’’ in a manner that is 
similar to using a transformer to reduce or increase electrical impedances. For 
example, if a pure inertial load is placed on the output of a gear train as shown in 
Figure 3.3.2a, the input torque required to accelerate that load is given by 

T, = 2 on S, (3.3.5) 
We may ask the question: What inertia is “‘seen’’ by the input shaft? Or in other 
words: What inertial load applied to the input shaft produces the same torque 
requirement as that of the original load? Figure 3.3.2b shows this equivalent 
system. 


Assuming that 7, accelerates an inertial load J.q at an angular acceleration 
of a@,, we may write 


OJ 4 = ~ Qs J. (3.3.6) 
Using the relauionships of Eq. (3.3.4), we may solve for the equivalent inertia Jea 
1 N, 2 


. a e 
For speed reduction and torque multiplication . 
ratio N,/N; Is less than 1. The reflected iner 


less than that on the load. 


at the output of the gear wee 
tia at the input shaft is see” 
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Shaft 1 





(a) : 


Figure 3.3.2 (a) Gear train with inertial load; (b) equivalent system. 


Besides inertia, both the reflected viscous and Coulomb frictions are reduced 
by a gear train. Figure 3.3.3 shows two gears each having an inertia and friction 
on their shafts. The total torque as seen by the input shaft is given by Eqs. (3.3.8a) 


through (3.3.8c). 


Tout > Vat TR2J,)6, + (By + TR°B2)O, + T; (3.3.8a) 
T, = F,, sgn (0;) + TR F,, sgn (62) (3.3.8b) 

TR = at (3.3.8 
N, .3.8¢) 


Note that both inertia and viscous friction are reduced (or increased) by the factor 
(N,/N,) squared, whereas Coulomb friction is reduced by the factor (N,/N2). Note 
also that Eq. (3.3.8a) is nonlinear. 

By making TR less than 1, it is seen from Eqs. (3.3.8a) through (3.3.8c) that 
the gear train is effective in reducing the reflected inertial and viscous loads that 
must be accelerated by a motor (or other actuator). This is an attractive feature 
since the actuator does not actually have to produce the high torque needed at the 
Output to drive the load but rather, a reduced value. Thus the actuator's size and 
torque capability can be significantly smaller than that required to drive the load 
directly, In robotic applications where large inertial loads must be accelerated, 
= Property of reducing the inertia is often utilized in order to reduce significantly 

€ size, weight, volume, and cost of the various joint actuators. 
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Figure 3.3.3 Gear train with torque and inertial loads. 


Practical considerations (i.e., physical constraints) can place certain limits on 
gear-type transmissions. For example, the amount of torque that an actual gear 
train can transmit before the forces on its teeth become large enough to cause 
breakage may constrain the actual implementation. Also, the physical size of 
gears may present a problem. Consider, for example, the following thought ex- 
periment. Assuming that we wished a very high coupling ratio on the order of 
100:1, then by Eq. (3.3.4) we see that the radius, r, of the output gear must be 
100 times greater than that of the input gear. If the input gear had a diameter of 
zin., the output gear would have a diameter of 50in.!_ This may be quite impractical 
for a reasonably sized joint of a manipulator. To overcome this problem, multiple- 
pass gear trainscan beused. This isa system of multiple gears mounted on different 
levels so that the distance from the input to the output shaft is minimized. While 
multiple-pass gearing may reduce the spacing between the input and output shafts, 
it increases the depth and is more complex, due to the increased number of part's. 

The opposite situation is the case where we wish the actuator and output 
be separated by a very large distance. If this is implemented by two gears, sal 
physical size of the gears may become quite large and due to necessary rigidity, 
quite heavy. The resultant inertia of these gears may make this approach una’ 
ceptable. Even for a multiple-pass situation (with the gears lined up to take UP 
the een the added complexity becomes a concern . h 

wo practical alternatives to ituati : or tne 
sna selene ieaied uel cana steal pe Situations are the harmonic drive [belt 
Pp to be as close as possible) and the pulley 
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in/Sp 


d to be separated 
rgc distance). 
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-type harmonic drive and its componen 
A ev eomponents of the harmonic drive are: 
“ee 
1c thre 


3.1.2 Harmonic drives 


tS are shown in Figure 3.3.4. 
Tl ular spline: a rigid, thick wall ring with inter 


1. eae or a rotating drive element. 


a fix enerator: an elliptical ball bearing assemb 
). inte “It is the rotating input drive element. 
—? a a nonrigid cylindrical thin-walled cy 
3. anger? smaller pitch diameter than that 
ad or rotating output drive element. 


nal spline teeth. {t is either 
ly which includes a shaft 


Pp which has two fewer spline 
of the circular spline. It is a 


Harmonic drive gearing is a patented principle based on nonrigid body me- 

‘cs. It employs three concentric components to produce high mechanical 
eae and speed reduction. The use of nonrigid body mechanics allows a 
ee elliptical deflection wave to be induced in a nonrigid external gear, 
eae weiiea a continuous rolling mesh with a rigid internal gear. 






Circular Spline 
A rigid, internal gear 


Wave Generator 
An elliptical 
ball-bearing assembly 


oe er a 


Flexspline 
A nonrigid, 
external gear 


Migure 3,3,4 Cut-type harmonic drive and its components. (Reproduced with the 
Permission of Harmonic Drive, a division of Quincy Technologies, Inc.) 
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of the relative 
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Rigid Circular Spline 


Flexspline output rotates : : 
P P IS rotationally fixeg 


in Opposite direction 
to input 


Figure 3.3.5 Analysis of harmonic drive motion. (Reproduced with the permis- 
sion of Harmonic Drive, a division of Quincy Technologies, Inc.) 


Since the teeth on the nonrigid flexspline and the rigid circular spline are in 


continuous engagement and since the flexspline has two fewer teeth than the circular 
spline, one revolution of the input causes relative motion between the flexspline 
and the circular spline equal to two teeth. Thus, with the circular spline rotationally 
fixed, the flexspline will rotate in the opposite direction to the input at a reduction 
ratio equal to the number of teeth on the flexspline divided by 2. 


The relative rotation may be understood by examining the motion of a single 


flexspline tooth over one-half an input revolution. Figure 3.3.5 illustrates this. 


(”. 


The tooth is fully engaged when the major axis of the wave generator input is a! 
When the wave generator’s major axis is rotated to 90° (in the clockwis’ 


direction), the tooth is disengaged. Full engagement occurs in the adjacent circulat 
spline tooth space when the major axis is rotated to 180°. This motion repeats ® 


the major axis rotates another 180° 
advancement per input revolution. 

Figure 3.3.6 shows how the harmonic dr 
perform six basic transmission functions b 
element. 


back to zero, thereby producing the two-too! 


; tO 
ive component may be set oF d 


y varying the input, output, and 
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output rotate in opposite directions. ‘ Out | 


eed Reducer: Flexspline held stationary. Wave Generator is 
ircular Spline is Output. Ratio as tabulated plus 1. 
d output rotate in the same direction. 


3, SP 
input. C 
Input an 


4. Speed Increaser: Flexspline held stationary. Circular Spline is 
input. Wave Generator is output. Ratio as tabulated plus 1. 
Input and output revolve in the same direction. 





5. Speed Reducer/ Differential: Wave Generator held stationary. Out 
Flexspline is input. Circular spline is output. 

Tabulated Ratio + 1 

Tabulated Ratio 

Input and output revolve in the same direction. 


Ratio = 





6. Speed Increaser/Differential: Wave Generator is held In 
stationary. Circular Spline is input. Flexspline is output. 


Ratio = Tabulated Ratio 0 | Or 
~ Tabulated Ratio +1 ut 7, 


Input and output rotate in the same direction. 


Figure 3.3.6 Transmission functions implemented by a harmonic drive. (Reproduced 
with the permission of Harmonic Drive, a division of Quincy Technologies, Inc.) 


3.3.1.3 Belt-and-pulley systems 


__ Figure 3.3.7 can be used to model an ideal belt-and-pulley or chain-and- 
Pa system. The analysis of this system is similar to that of the ideal gear 
direct mole that In this case, the relative — both shafts are in the _ 
trains is liming belts and chains perform essentially the same ee ~ 
over | lowever , they allow the transmission of the rotational motion and torqu 
“nger distances without the need for multiple gears. Figure 3.3.8 shows a 


5: Components, Dynamics, and Modeling 


.. 


128 Mechanical System Nap ; 


Belt 


Th, 6, 


ne, 


Te 6, 


Figure 3.3.7 Ideal belt and pulley system with parameters. 


timing belt and toothed pulleys. As opposed to a belt and pulley, this Method 
will not allow slippage between the belt and sprocket due to the teeth; however 
it will exhibit a spring constant if the output is locked and a torque applied to the 
input. 





Figure 3.3.8 Timing belt and toothed pulleys. 
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R tary-to-Linear Motion Conversion 
0 
3.3.2 


, linear motion conversion is concerned with takin 

arv- ()" 2 ; $ 

Rotary auc from an actuator and producing a linear motion 
0 ej a |i i i 

and! enits Whose ideal model produces a linear relationship between the input 

Compr ation and the output’s linear displacement are / 


the lead screw : 
) ; . , tack and 
ean, and Roh'lix. Nonlinear relationships are available by slider-crank assem 
inion. : 


g the rotational motion 
and force on the Output. 


3.3.2.1 Lead screws 


Figure 3. 3.9 shows a lead screw driving a payload along a single axis. In this 
~onfiguration, the screw is fixed with Its ends free to rotate. As the screw is turned, 
the nut moves along the shaft with the payload attached. Typically, the payload 
supported and moves along a Surface with a very low frictional component. A 
rotary displacement of the input shaft, 6,, causes a linear motion of the payload, 
x. The coupling ratio 1s defined as the Input shaft rotation per unit of linear 
motion. A typical rating of a lead screw 1s 10 turns/in. This is also referred to 
as the pitch (P). An alternative coupling ratio is given by the reciprocal of the 
pitch, which is called the lead. This factor (L) is defined as the axial distance the 
screw or nut travels in one revolution and may be given in such units as in./rev or 
cmiturn. A lead screw having a pitch of 10 turns/in. has a lead of 0.1 in./turn. 
Therefore, we may write the following relationships for the system of Figure 3.3.9: 


0 = Px (3.3.9a) 
x = L0 (3.3.9b) 


These equations may be differentiated any number of times in order to obtain the 
relationships among linear velocity, acceleration, and jerk, and rotational velocity, 
acceleration, and jerk, respectively. 

Just as in the case of rotary motion conversion, we are interested in how a 
load on the output is seen by the input. That is, is there an equivalent torque- 
inertia system for Figure 3.3.9? The derivation of the inertia reflected back to 
the input shaft is based on a balance of kinetic energy. For the linear motion of 
the payload’s mass, M,, we may write 


E, = = Mv? (3.3.10) 
the corresponding kinetic energy of a torque-inertia system is defined as 
E, 2 2 J equ? (3.3.11) 


uating the kinetic energies of Eqs. (3.3.10) and (3.3.11) and solving tor the 
Tila, Jeg, after relating the rotary and linear velocities by the pitch, yields 





M Wig (3.3.12) 
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Figure 3,3.9 Lead screw with payload. 


Equation (3.3.12) shows that the reflected inertia of a load driven by a lead screw 
can be reduced by choosing a lead screw with a greater pitch. 


3.3.2.2 Rack-and-pinion systems 


he 
Figure 3.3.10 shows a representation of a rack-and- -pinion gear train. on 
pinion is the small gear attached to the actuator, and the rack is a linear saga 
with gear teeth on one side. The transfer relationship of such a mechanical syst 
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Payload 





Pinion 


Figure 3.3.10 Rack-and-pinion driving load. 


is defined as 
x=27r0 (3.3.13) 


As defined by Eq. (3.3.13), the linear distance traveled is proportional to the input 
shaft rotation (in revs), with the constant of proportionality equal to the circum- 
ference of the pinion. That is, the linear distance traveled is equal to the distance 
traveled by the pinion. The reflected inertia, as seen by the input shaft, can be 
shown to be 


J = Mr’ (3.3.14) 


3.3.2.3 Belt and pulley driving a linear load 


Another method of generating linear motion from rotary motion is shown in 
Figure 3.3.11. Note that both pulleys have the same radius. The pulley connected 
to the input is called the drive pulley and the second pulley is called an idler pulley. 
The distance traveled by the load is equal to the distance traveled by the drive 
pulley. Equation (3.3.13) also describes the transfer relationship of the belt and 
pully system while Eq. (3.3.14) is the reflected inertia as seen by the input shaft. 

_ In practical implementations of the lead screw, rack and pinion, and linear 
Ve via belt and pulley, there are physical limitations on the linear motion. For 
xample, if the linear motion exceeds its designated range, it typically hits an “end 
0p.” This mechanical contact forces the rotary shaft to lock. In the event that 
~ Continues to be applied to the shaft in this locked position, it is possible 
reme forces to be generated, causing the devices to fail (i.e., the threads of 
wi °r nut strip, or gear teeth break). The practical solution to this proven 
ne “Ce electrical limit switches some distance before the physical limit is a . 
can b pal irom these switches is used to stop the actuator before a damaging force 

« applied at the extreme limits of motion. 
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Figure 3.3.11 Rotary to linear co 


3.3.2.4 The Roh'lix 


An interesting mechanical device that overcomes this end travel problem js 
the Roh'lix (trade name). Figure 3.3.12 shows the Roh'lix. This device is baseq 
on the principle of rolling contact. The drive shaft is the long shaft (as comparec 
to the screw in a lead screw), while the “nut” 1s composed of six freewheelin; 
bearings connected to idler shafts mounted in a block. There are three shafts a 





Figure 3.3.12 Roh'lix mechanism, (Reproduced with the permission of Zero-Max, 
a unit Of Barry Wright, Minneapolis, MN.) 
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yf the nut which are mounted at an 
each — block containing the idler shafts 
shall. i rotation of the drive shaft. 


fiona i" teresting property of this device is that when it reaches 
f - the input shaft Jamming, It continues to rotate while 


m9 relative to the axis of the drive 
Wil Move in either direction propor- 


its limit of travel, 


pone the nut remai 
ad an ains 
inste ‘the stop. The shafts slip and no damage occurs. The Slip occurs when a 
a: 
} rust OF overload point 1s equaled or exceeded. The slip can be a disad 
se ; 


ian servo-controlled application, since if an obstruction of sufficient torque 
yantag he input shaft will slip and the position calibration will be lost Therefor 
occurs. of this device requires a feedback transducer on the linear portion 7 
‘posed to the driving member. 
L 


3.3.2.5 Slider cranks 


The slider-crank mechanism is an extremely cost-effective means of converting 
-otary to linear motion. Figure 3.3.13 shows a representation of a crank driving 
, linear stage (or load). In this implementation, the crank portion is the wheel 
that rotates about its center and has a rod of fixed length mounted to a point on 
ts circumference. The other end of the connecting rod or link is attached to a 
inear stage which is constrained to move in only one dimension on a relatively 
frictionless surface. At both its locations on the disk and linear Stage, the con- 
necting rod is free to rotate. Thus the angle formed with the horizontal will change 
as a function of the disk’s position. 

As the disk travels from 0 to 180° in the counterclockwise direction, the linear 
stage moves a distance equal to 2r. If the disk continues to travel from 180° back 
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Figure 3.3.13 Slider crank driving linear stage. 
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| P.3 
to 0° (still in the counterclockwise direction), the load will move jn th 
direction over exactly the same linear distance. Note that there are two ep Omit 
angular positions of the input shaft that correspond to a single linear Posie, tinet 
the load. ; ON of 
The angular positions that correspond to full extension and retraction 
linear stage are called dead-center positions or dead points and occy, Wh Of the 
crank and connecting rod are collinear. If this system is used to conver lin. the 
rotary motion (as is typically done in a gasoline reciprocating engine), a fl 
with sufficient inertia must be connected to the crank’s axis of rotation. YWhee| 
for this is that when the connecting rod and crank are in line at a dead poj t 
direction of rotation may go either way. Thus the inertia contribution of #. 
flywheel is necessary to bias the mechanism for proper operation. the 
If the input shaft is rotated continuously at some velocity, the MOtion of 4 
linear stage is reciprocating. As can be observed by a careful eXamination " 
Figure 3.3.13, the torque seen by the input and the relationship between the in i 
Shaft’s position and linear stage’s position are nonlinear in nature. ie 


3.3.2.6 Cams 


Cams can also provide a nonlinear transfer of rotary to linear motion. The 
cam is an irregularly shaped machine which is driven by some type of motor, 
Touching the surface of the cam is a follower bearing to which the cam surface 
imparts motion. Figure 3.3.14 shows a cam with a follower while Figure 3.3.15 
Shows the accompanying displacement diagram. For the system shown in Figures 
3.3.14 and 3.3.15, as the cam rotates, the follower touches its surface. Thus the 
rotary profile of the cam is imparted to the follower, which in turn Causes a linear 
motion of the arm. The actual velocity, acceleration, and jerk of the linear motion 
can be defined by the shape of the cam. 

It should be noted that cams are very common in automatic machine: 
because they provide a simple method of providing almost any desired followe 
motion. By using a simple limit switch and motor, a cam may be driven on 
revolution and thus produce some desired motion of its follower. As can bi 
seen from the displacement diagram, the follower may extend rapidly, dwell 
retract partially, dwell, and then return to its Original position as the limit sto, 
IS again reached. 

The analysis and design of cams is abundant in engineering literature and th 
interested student should reference one of the many machinery design texts . 
mechanical handbooks. Cams are not generally used for implementing the linea? 
joints of 4 programmable robotic manipulator, due to the inherent nonlinear tan 
fer characteristics for position and torque. However, these and other classic 
mechanica! devices are widely used in implementing the special motions require 
by end effectors or other peripheral equipment in workcells. In fact, many S!™P 
pick-and-place mechanisms use cams in their implementation. 
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Figure 3.3.14 (Cam with follower. 


3.3.3 Linkages 


father than include linkages in the rotary-to-rotary or rotary-to-linear conversion 
discussion, the subject is discussed as a Separate topic. It should be noted that 
sefore the advent of computer-controlled machinery, the complete cycle of an 
automated machine was controlled by cam profiles and/or linkages. 
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Maximurn 
Minimum, . 
0 45 180 200 320 360 


Cam Rotation in Degrees 


Figure 3.3.15 Cam displacement diagram. 
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C 
hap 3 
Lig 
L,4 is provided by distance 
between mounting surfaces 
of joints 1 and 4. Figure 3.3.16 Four-bar linkage. 


The four-bar linkage of Figure 3.3.16 is one of the most common iN use 
Most complex mechanisms can be studied or reduced in terms of the four-bar 
linkage [10]. 

Various permutations of moving or fixing certain links with respect to ground 
along with the relationships between the lengths of the links, allow the basic four. 
bar linkage to perform different functions. For example, Figure 3.3.17 shows 4 
situation in which links L,, and L3, are replaced by disks. The length of L,, is 


Physical Link 


Link provided by radius of 
disk whose length 
is Ly2 





Lig provided by distance between 
mounting surfaces of joints 1 and 4 


Figure 3.3.17 Four-bar link 


age using disks for two links. 
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Rocker Arm 


Link L,4 provided 
by mounting surface 


Figure 3.3.18 Crank and rocker. 


equal to the distance between the centers of the two disks. Link L,3 is coupled 
to the two disks in such a way that its motion is unconstrained in the plane of the 
disks. Ifthe disk on the left is rotated at a constant velocity, the disk on the night 
will also. When L,; is coincident with the centers of the disks, a dead point occurs. 
Here it is possible for the rotation of the follower to be in the direction opposite 
to that of the driving disk. As indicated in the discussion on slider cranks, an 
inertial disk may be used to bias the motion in the desired direction. 
Another configuration of the four-bar linkage is called the crank and rocker. 
This device transforms rotary motion into oscillating motion (see Figure 3.3.18). 
Either link L,, or L34 can be the driving member. If Ly is rotated about its pivot 
point, then L;, oscillates back and forth between its two extreme points, Ap and 
A,. If link Ly, is the driver, it is necessary to bias the direction of rotation of link 
L,, by an inertial disk since two dead points occur at the extreme points of link 
Lay, 
The slider-crank mechanism discussed in Section 3.3.2 (see Figure 3.3.13) is 
a special case of the four-bar linkage. By making link Ls, infinitely long, joint J; 
is seen to move in a straight line. By replacing link Ls4 by a slider, we obtain the 
kinematic diagram of Figure 3.3.19, which is equivalent to the implementation 
discussed previously. | 
— ,; nsidered is the 
| The final application of the four-bar linkage that will be co as eeubiel 
ta of Figure 3.3.20. This device is commonly used . he we ae . id 
and ran a The mechanism provides a parallel mo’ use of this mech- 
ylus, which, of course, are interchangeable. An obvious 
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hap,» 





| Figure 3.3.19 Slider cr 


ank f 
bar linkage. TOM four. 


anism (provided that there is space for the linkages to operate freely) js for ™ 
ducing remote-controlled motion of the stylus point by moving the pen sae 
Essentially, when used in this way, the mechanism is a teleoperator in two dimen. 
sions (see Chapter 1). 

The mechanism of Figure 3.3.21 shows an interesting implementation of : 
Single-jointed manipulator. As opposed to utilizing a rotary actuator to MOve the 
“arm” as was discussed in Figure 3.2.6, here the length of link 1 changes, Causing 
link 2 to move. Link 2 is fixed in length and free to pivot on the vertical] support, 
while link 1 could be implemented by a lead screw. One end of the screw is fixed 


to the vertical support but free to pivot, while the nut is coupled to link 2 with 
another pivoting device. 





Pen (or Stylus 
stylus) (or pen) 
point point 


J, is fixed: Jy, Jz, J4 are free to move in the plane of the drawing. 


Figure 3.3.20 Pantograph. 
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Figure 3.3.21 Linear drive for rotary joint. 


3.3.4 Couplers 


A coupler is a device used to connect shafts so that one can drive the other. 
Typically, it is used to connect an actuator or motor to the rest of the joint mech- 
anism. In the ideal case, all that is required of the coupling is to transmit the 
orque, velocity, and position from the actuator to the rest of the system. However, 
‘ince the world is imperfect, the job of couplers is much more difficult. As nothing 
aoe up perfectly [e.g., shafts may be parallel but not collinear, or they may 
ve (sO as to intersect at a point)], rigidly coupling the shafts would not be 
io there is a need for a device that can compensate for these mis- 
Although shaft couplers come in a variety of configurations and specifications, 


they a se es 
“y are “ommonly used to solve the misalignment problems shown in Figure 3.3.22. 
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8p, 3 
Aligned (axes colinear) 
0 
Angular Misalignment 
Parallel Misalignment 
Axial Misalignment Figure 3.3.22 Shaft misalignment. 


Figure 3.3.23 shows a front and side view of an Oldham coupling, a device used 
to connect two shafts that are parallel but not collinear. The two outer plates that 
connect to the shafts each have a groove in them. The inner plate has a raised 
surface on each side which fits into the grooves on the outer plates. Since the 
raised surfaces are 90° apart, the coupler allows for misalignment of the two shalts 
in the plane of the plates. Since there is no relative motion between any or th 
three plates, this coupling permits a constant-velocity ratio to be transmitted. 
course, since the shafts are constrained to remain fixed along their axial direction, 
as one rotates, the coupler moves in x and y so as to impart the desired motion 
the second shaft. The Oldham coupling is typically used to couple a motor’s sha 
to the wave generator of a harmonic drive. 

The universal joint is used for connecting two shafts whose axes 
line but intersect at a point. There are many possible implementatio 
universal joint, as depicted in Figure 3.3.24. However, it does not wor 


k well ! 


n Conversion as 


Motio 





sh qroOve Right outer plate with groove 
rer plate with a perpendicular to plane of 
tf to plane OF PAPT paper. 
calle 
| ith a raised 
er plate with a 
ce on each side. The 


ight 
‘cad surfaces are at a rig . 
ee to each other. Figure 3.3.23 Oldham coupling. 


the angle 5 is more than 45°. Preferably, the angle should be limited to less than 
95° except when the speed of rotation is very slow and little torque needs to be 
transmitted. a 

The flexible shaft coupler shown in Figure 3.3.25 is a feasible alternative to 
both the Oldham coupler and the universal joint. These devices come ina variety 
of configurations, including the “accordion,” “split-ring,” and rubber, to name a 
few. Typically, shaft couplers are rated by the maximum amount of angular and 
parallel offset they can accommodate and also by the maximum torque they can 
transmit. In addition, when designing a system, we are interested in their inertia, 
their torsional spring constant, and their viscous damping component. We explore 
4 model for the flexible coupler in Section 3.5.3. 


3.3.5 The Concept of Power Transfer 


In Section 3.3 we defined the equivalent inertia as seen by the input shaft, for both 
a gear train and lead screw. For the case of the gear train it was observed that 
the load inertia could be reduced by a factor of (N,/N,)* thus making the torque 
requirements of the actuator lower than if it had been forced to drive the load 
directly. Similarly, the inertia seen by the lead screw is also controllable by its 
coupling ratio. An obvious question is: What coupling ratio should be chosen? 
lf the desired characteristic of the transmission is a speed or torque change, the 


Figure 3.3.24 Universal coupling. 








Figure 3.3.25 Flexible shaft couplers 
Corp., Huntington Beach, CA.) 7 
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(Reproduced with permission of Rocom 
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ratio is chosen per the design specification. 

-. the energy dissipated in an actuator such as a 
. choose the coupling ratio based on the prin 
i tated, this concept uses the coupling ratio to ma 


ke the ref] sate: 
ve aply stated, NP elected load inerti 
atin the inertia of the dc motor. Thus, for a speed-reducing gear train ee 
u “4 choose the ratio (NV,/N2) by the following formula: aw 


cg 


However, if one wishes to 
de motor (see Chapter 4), 
ciple of an inertia] match. 


minim 


Mi [ke 


Ny VJ; (3.3.15) 


: | inertial load on the output, while J, ; a 
¢ J, is the tota put, whule J; is the inertial load on the 
oa due to the aca Compare Eq. (3.3.15) with Eq. (3.3.7). Similarly, one 
can define an optimal pitch for a lead screw which minimizes the energy dissipated 
nthe actuator as 
tM 
27 Vj J, (3.3.16) 


where J, is the inertia of the actuator driving the lead screw and M, is the mass 
of the load. 

Equations (3.3.15) and (3.3.16) may be derived by writing an equation for 
the total torque that must be provided by the dc motor, defining the current of 
the motor in terms of the required torque, and finally minimizing the power that 
must be dissipated in motor with respect to the coupling ratio. It should be 
apparent that the expressions become more complex if constant and viscous friction 
terms are included in the derivation. 


34 SOME PROBLEMS WITH REAL-WORLD COMPONENTS 


In our previous discussions we considered only “ideal” mechanical components. 
However, real-world components do not necessarily behave as their ideal models, 
although they may approach this behavior in certain circumstances. In addition, 
even though a component may be specified very tightly, its performance may be 
lar from specification if it is used improperly. 

_ Typically, it is reasonable to say that the closer an actual component behaves 

lo Its ideal model, the more costly it becomes. This is usually because its man- 
wacture requires more precise and careful steps. Ideal behavior, while desired, 
may be cost-ineffective or actually unnecessary in certain cases. 
Tt one understands the components and their interworkings in a particular 
Kd and the desired composite specification of the final product or system, 
ine es trade-offs can be made against cost, complexity, and the errors that the 
that oe may introduce. The following sections define some sane errors 
beets be quantified for the mechanical components discussed previously or lo 
~~" Mechanical systems. 
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3.4.1 Efficiency 


Efficiency y is defined as the ratio of the output power to the input : 

ratio of the work output to the work input over the same period of time Pal 
ideal mechanism. the efficiency is 1 or 100%. Inthe case of real com nen sak 
Work output is less than the work input, with the difference being dissipar: : 
friction. Equation (3.4.1) defines efficiency. ed 


power out _ work output 
= ‘power in-work input (3.4 
For the case of a gear train, we may restate Eq. (3.4.1) as the Ta 


he Ho of the 
actual output torque divided by the ideal output torque. Thus for a 


: -., , OWal trgj 
having a tooth ratio TR of N,/N,, with N,>N, so that torque multiplication results 
we obtain | 


_ actual output torque 
input torque/TR (3.4.2, 


Figure 3.4.1 shows a transmission consisting of a night-angle gear train hay; 


Ving a 
tooth ratio of is and a set of antibacklash gears having a ratio of}. A plot of th: 
input versus the output torques for the assembly is shown in Figure 3.4.2. Not 


that the actual overall transmission has a measured efficiency of only 22% x 
compared with an ideal performance of 100%. Although it is possible for efficiency 
to be a function of speed, a first approximation would consider it to be dependen: 
Only on the forces encountered by the gear teeth, which are primarily frictional ir 
nature. Since these forces are directly proportional to torques, the efficiency oi 
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Figure 3.4.1 Complex gear assembly. 
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Figure 3.4.2 Actual and theoretical torque transfer curves. 


the transmission can be approximated by measuring the resulting torque on the 
output for static torques applied to the input shaft. 

The efficiency of any mechanical device becomes important in sizing actuators. 
It is no longer safe to assume that the output loads are reflected to the input shaft 
by a function of the gear ratio as defined in Eqs. (3.3.8a) through (3.3.8c), but 
one must now include the efficiency. These equations then become 


TR’. \. TR? 
Lsotal — U, + TE 1 )8 7 (2, i = B 0, + T; (3.4.3a) 
n 


TR 
T; = F,, sgn(6,) + — F,, sgn(0,) (3.4.3b) 
n 
TR = 4 (3.4.3c) 
N, 


on Cauation reveal that any efficiency less than 1 (i-e., 100%) will increase the 

load. are to accelerate a given inertial load or overcome an external torque 

atio of a ‘Mportant to note that efficiency does not affect the actual —— 

OF accele . 8€ars (or other transmission device) in terms of displacement, velocity, 
mon, but greatly affects any torque-related property. 
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A EFFICIENCIES FOR 


TABLE 3.4 
MISSION 


SOME TRANS 
COMPONENTS 


Lead screw 
Acme type 25-85 
Ball type 70-90 
Roh ‘Tix 90 
Worm gears 46-98 
62-83 


Harmonic drive 
f the mechanical devices described 


Typical ranges hay 
previously are given In Table 3.4.1. It should be noted that the efficiency tabulated 
is dependent on such factors as the coupling ratio, the material’s coefficients of 
friction, and the angle used to define the gear teeth or the depth of cut and type 
of threads for screws. 

An interesting side effect of efficiency is the ability to backdrive a transmis- 
sion. For example, if one pushes on the linear stage connected to a lead screw, 
does the screw turn or does the stage remain locked? In general, the higher the 

e backdrivable. 


efficiency of a transmission, the more likely it will b 
Some transmissions are designed so that they are not backdrivable. In fact, 
this may be a desirable feature in certain designs. However, in the case of servo- 


controlled mechanisms, the ability to backdrive a transmission 1S extremely important. 
A. nonbackdrivable transmission introduces a nonlinear transfer element into a me- 
chanical system. Consider, for example, a position servo loop in which the motor Is 
connected to a purely inertial load by means of a transmission. In theory, by adjusting 
various gains in the system, one should be able to control the amount of overshoot 
and settling time of the response of the system to a step input. If the transmission 
is not backdrivable, a nonlinear device is in the loop and the energy of the inertial 
disk cannot be transmitted back to the motor. Unless energy can be both “sourced” 
the motor, the motor working in the loop will not have the ability 


of efficiency for some O 


and ‘“‘sinked” by 

to dampen out the motion. Thus the system begins to exhibit nonlinear behavior 

and may possibly become unstable, e.g., have a limit cycle. 

3.4.2 Eccentricity 

One of the phenomena that affect the displacement transfer characteristic of geal 

(or any rotating parts for that matter) is eccentricity. Figure 3.4 3 shows 4B ideal 

and an eccentric disk. The ideal disk spins on its true center Therefore, if pol 
oint 


A is identified on the circumference of the disk and the disk is th otatee; 
A stays on the path identified by the circumference f he ais a i : that exhibils 
eccentricity does not rotate on its true center b : rei isk. A A atte $ 
shown on the nonideal disk in Figure 3.4.3, A is the arenpeah or eumferen 
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ideal Disk: 


Ideal center of rotation 





Rotation of 90° causes 
point A to travel along 
the circumference % 
of its distance to A’ 


Non-Ideal Disk: 







True Center Center of Rotation 


of Disk Rotation of 90°, 180°, 270° 


and 360° moves A and B 
to locations shown 


Figure 3.4.3 Disk on true center and disk on eccentric. 


of the disk that is the closest to the center of rotation. Note that as the disk is 
rotated, this point does not stay on the path that would be defined by a tracing of 
the circumference but rather follows a circular path defined by its radial distance 
from the off-center rotation point. B isa point on the circumference of the disk 
which is farthest from the center of rotation. It also traces out a circular path 
defined by its distance to the center of rotation. Note that as the disk is rotated 
over one full revolution, the referenced points return to their original position. 
Eccentricity is defined as the distance from the true center to the center of 
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Figure 3.4.4 Measuring TIR of shaft or disk. 


rotation. It is easily measured by dividing the total indicated runout (TIR) by 2. 
Figure 3.4.4 shows a method of measuring the TIR or eccentricity of a shaft. 


3.4.3 Backlash 


Since rotating components can always have an error due to eccentricity, there are 
problems in interfacing components such as gears. Consider for example, the cas¢ 
of two gears as shown in Figure 3.4.5. Since both gears rotate about a point slightly 
off center, it is possible (depending on how the system is assembled) for point 
on each gear to make contact on each revolution. If one were to measure tHe 
torque on the input shaft for a full revolution, it would appear greater when me 
two high spots (occurring at point B) meet. In addition, if the gears were adjust¢ 
so that the tecth meshed as perfectly as possible at the high spot, then at point 


ot 
(the Jow spot), there would be space between the teeth. Since the gears Soul 
exactly meshed at A, if one of the shafts were held stationary, a small motion ster 


be felt on the free shaft as it was rotated in both the clockwise and the COU" 
clockwise direction, ‘This phenomenon, called backlash, is depicted in Figure ~ 
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Figure 3.4.5 Two gears with eccentricity. 


Ascan be seen, motion of the input does not cause the output to experience motion 
until the gap between the two members is removed. This so-called deadband 
behavior contributes a nonlinearity to mechanical systems and can cause discon- 
finuities in velocity and acceleration, leading to high mechanical stress of com- 
ponents. Backlash can occur in both translational and rotational systems. 

The manner in which backlash behaves in a dynamic system is dependent on 
the friction between the two contacting surfaces and also on the relative inertias 
of the input and output. Consider a system in which the inertia associated with 
the output is much less than that of the input. There will also be a large frictional 
load connected to the output. Referring to Figure 3.4.6, if there is no contact 
between the two members when the input stops moving, the output will tend to 
stop since it has low inertia and a friction force to stop it. When motion of the 
input begins, it will travel along the deadband until it makes contact with the 
output. If the input member reverses direction, the output will stop until the input 
travels the distance necessary to take up the backlash. Once the backlash is taken 
P, the output member instantaneously takes on the velocity of the input member 
a moving. Figure 3.4.7a shows the transfer relationship for this con- 
, ane ney where the output friction is negligible and the inertia of the output 
cS, the | : ¢, the nonlinearity due to the deadband behaves differently. In this 
the alent ua of the output tends to keep it in contact with the input as long as 
stcleration ey Is in the direction to keep the members in contact. When the 
ately bu i” the input becomes zero, the output member does not stop imme- 

asts at a constant velocity, that is, at the maximum velocity attained 
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ha 
Pg 


Figure 3.4.6 Backlash model. (Ben: 
, ‘ min C. Kuo, Automatic Contro| Sys a- 
- 3 tems, Se, © 1987, Pp. 133, 143. Re. 
printed by permission of Prentice Hall 
Inc., Englewood Cliffs, NJ.) ) 


by the input. When the output has traversed a distance equal to the full backlash. 
it will be restrained by the opposite side of the input member. When contact js 
made, the output again assumes the velocity of the input. Figure 3.4.7b shows 
the input/output relationship for this second condition. 

To minimize the problems of backlash, provisions must be made in the design 
of mechanical systems for adjusting one gear relative to the other, thereby affording 
complete control over backlash at initial assembly and throughout the life of the 





(a) Input-Output characteristic of backlash (b) Input-Output displacement characteristic of 
with negligible output inertia. a backlash element without friction. 


Kigure 3.4.7 Input-output relationships for backlash model. (Benjamin C. Kuo, 
Automatic Control Systems, Se, © 1987, pp. 133, 143. Reprinted by permission of 
Prentice Hall, Inc., Englewood Cliffs, NJ.) 
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Meshing of 
anti-backlash 
gear with 
single tooth 


Figure 3.4.8 Anti-backlash gear 
assembly. 





A number of techniques for doing this exist. For example, if one gear is 
purposely mounted on an eccentric shaft, the meshing of the teeth can be adjusted 
periodically as the gear surfaces wear down. In addition, at initial assembly, one 
can match the high spot of one gear to the low spot of the second. This attempts 
to cancel out the eccentricities. Of course, this approach is good only for integer 
ratios, since other ratios will not guarantee consistent line up of the low and high 
spots of the two gears. 

Antibacklash gears are another method used to reduce the problem. In this 
approach, the gears are composed of two sets of teeth that slide over one another. 
Spring loading 1s used to ensure that the gear teeth of the antibacklash gear spread 
apart and tend to fill the space between the teeth of the gear with which they are 
‘1 contact. The double-teeth arrangement of an antibacklash gear is shown in 


Figure 3.4.8. 


geals. 


3.4.4 Tooth-to-Tooth Errors 
_to-tooth errors (affecting 


cturing process (1.¢., no 
in tooth thickness, 


| gear’’ were used 


Another problem experienced by real gear trains 1s tooth 
their accuracy). ‘These arise from errors in the manufa 
teeth are identical). The three major contributions are errors 


tooth profile (shape), and the roundness of the gear. If an “idea = 
to drive a gear under test, a plot similar to that of Figure 3.4.9 would be obtained. 


It is seen that the general characteristic of the error 1s sinusoidal. The compe ye 
waves superimposed over the longer-period wave are due to the rr u 
individual teeth, whereas the longer period 1s due to the eccentricity 0 ae 
blank. Taken together, they define the total composite error, which is — 
total indicated runout (TIR) (see Section 3.4.2) defined for rotating members. 
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Total Composit Error=TIR 


Gear Angle (degrees) 


Figure 3.4.9 Gear error over one revolution. 


3.4.5 Other Errors 


From the discussion in previous sections It should be evident that robotic Manip- 
ulators can experience various errors due to inaccuracies 1n their mechanical com. 
ponents. Besides the errors due to nonlinearities, perpendicularity can affect the 
positioning accuracy of a manipulator. Consider, for example, a two-axis cylin- 
drical coordinate manipulator as shown in Figure 3.4.10. Ignoring the errors in 
the drive components, if the link that positions @ is eccentric, the distance from its 
center of rotation to the tip of the extension arm may not be known exactly since 
the extension arm may be placed on either the high or low spot or anywhere in 


R 


—_—_> 


Figure 3.4.10 Schematic of two-axls 


cylindrical manipulator. 
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3.4.6 Vibrations 


Mechanical vibration of a system is motion that re 
of time. Every system has associated with itan 


will vibrate at its natural frequency if excited by animpulse. These free vibrations 
are due to internal forces and are transient in nature. Forced vibrations result 
when a system is acted on by an external periodic force. These vibrations are 
steady state in nature and go away only when the forcing function is removed. 
Resonance is a phenomenon that occurs when the frequency of a forcing 
function 1s the same as or near the natural frequency of the system. This vibration 
ive j be avoided. 
can be destructive in nature and should —- 7 
Since all physical systems consist of mass (or inertia) and elasticity, - 
lement be used to model vibrations that occur in all physical systems. As 
eran be modeled by lumped springs, 
will be seen in Section 3.5, mechanical systems may be nie nba Gethin 
masses (Or inertias), and dampers. By setting up an rh one ceeneual 
its dynamic behavior in terms of a differential _— the na 
dye: boning: natty hb ne oc vicstionn of physical structures and 
It is important to distinguish between : sts. In robot design, 
the Pasting caused by the interaction of —— ea mountings for the 
and physical structure of the mechanism, that is; 4 should not resonate at fre- 
actuators ¢ } be sufficiently stiff and s The mechanical 
actuators and castings, must be anipulator. 
NCies ited by motions of the m hemselves must 
quencies that can be excited by ae name a few) t 
d transmissions, to ected together 
elements (actuators, couplers, and tr uired, and when connectes’ ; 
de chosen to transmit the torques or forces age desired range of operation. 
“Sa system should not possess resonances in 


peats itself over a finite period 
atural frequency. The system 
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lement or modal analysis may be useg 


ivide a Structure into q 

objective of the finite-clement method is Os shafts, and. «c 7 “SSembla,. 
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These equations do not necessarily contain ma i ; ; stants and 

ssociated with the lumped elements on the s 


damping coefficients, which are associate’ ° 
ture " aoe the mathematical model Is built, the i eerie Bs uae be soly 
using computer methods, and various studies showing the response of the Struct 


to stimuli can be done. Finite-element modeling has two main Cisadvantages, 

a large model is extremely complex and 1s expensive (in bo _ Ime and labo; t 
develop and simulate on a computer, and (2) the nese oe if the 
finite elements do not approximate the real-world conditions we enough. Thus 
even though a model is developed, it is necessary to test the structure dynamically 
to compare the physical system with the model. | | 

Modal analysis (based on transfer function techniques) has become increas. 
ingly popular since the late 1970s. This technique 1s based On measuring the 
transfer functions between a single impulse point and multiple points on the Struc- 
ture. Modal parameters (i.e., the frequencies of vibration and their amplitude) 
may be obtained from these multiple measurements. Finally, a line drawing con- 
necting the measurement points (and defining an outline of the structure) can be 
animated to show an accurate picture of the deflections that may occur for the 
various structural frequencies. 

To study the dynamics due to the mechanical components associated with the 
motion of a joint, it is possible to use a lumped-parameter approach. In this 
technique (detailed in Section 3.5) one models the joint and link of a manipulator 
as a spring—inertial—damper system. The actual structure is lumped into one mass 
or inertia. This simple model is sufficient to point out potential system problems 
[such as resonance frequency as a function of payload (see Section 3.5.3.1)] and 
gives the designer feedback on the choice of component selection. 


mnite-€ 
To study a structure, finite 


3.4.6.1 Critical shaft Speed 


Another concept in the study of vibrations is the critical shaft speed, defined 
as the speed that causes the shaft to vibrate excessively in a direction erpendiculat 
to its center of rotation, In fact, if allowed to Operate at this s jae? permanent 
aaa Or structura] damage may Occur. An example of aa ie the case of 
of a oka presets Bravity of the disk is different from the center of gravity 
bolic patie bile ‘ ie mounted, due to balancing problems (as in the cas¢ 0 
ihe chia ta. ures) (see Figure 3.4.11). Ifthe shaft and disk are rotated, 
crated by the side directly one DY the heavier side will be greater than that gen 
heavier side, causing the “cose 7 The shaft will tend to deflect toward i. 
condition holds true UP to a certain ny disk to rotate in a small circle. 1 

al which excessive vibrations occur. 
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Figure 3.4.11 Critical speed rotation of disk on shaft. (From Kinematics and 
Dynamics of Machines, by George H. Martin, Copyright 1969, McGraw-Hill Book 


Company, NY, NY.) 


this speed, the axis of rotation changes from the geometric center : pea 
io an axis through their combined center of gravity. The shatt ASS Tagine the 
flected so that for every revolution, its geometrical center scan oie a rotation 
center of gravity of the rotating mass. As the speed increases .. : naan 
reverts back to the geometric center and the vibrations cease. 


can be thought of as resonance. 
Critical speed becomes an important d 
: e place 
are used to transmit torque or to allow an pasesit aad demanded of the 
rom 4 transmission, we must ensure that the angu . ad screw also exhibits this 
actuator fall below the critical shaft speeds. The vemnetait of the lead screw, 
phenomenon. Besides material and construction P# 


frequene y e 


Figure 3.4.12 shows four possible ways of supportn d fixability factor” (see Figure 
that the critical frequency is a function of C,, the “the distance between bearing 
5.4.12); D, the mean diameter of the screw: L, 


ot design because if shafts 
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factor in ~ome distance 
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Figure 3.4.12 Bearing support of lead screw. 


h defines the material and construction propertie, 


supports; and a constant k, whic 
of the screw under consideration. 


f. = kC (3.4.4) 


DB 
Of course, a safety factor (0.8f.) should be included to ensure that operation is 
below the critical speed since this ‘s a first order model. Thus in applying a lead 

be necessary to compromise the maximum 


screw for prismatic joint design, it may spe 
linear speed and reflected inertia in view of the lead screw’s critical shaft speed. 


3.5 MODELING OF MECHANICAL SYSTEMS 


The objective of modeling mechanical systems is to provide a way to express 
mathematically the relationships between such quantities as the input torque toa 
physical positions of various components. The combination of 
elementary mechanical components such as lumped inertias or springs results in a 
“mechanical network” which may be analyzed by differential equations, Laplace 
transforms, or simulation techniques. In addition, electrical analogs of the vari- 
ables and parameters of the mechanical network can be formed. These analogous 
circuits can provide a very simple and cost-effective method of physically modeling 
4 mechanical system without the need to fabricate mechanical components 0! 
directly solve the differential equations. If a test signal (such as a sine wave 
step function) is applied to the analogous electric circuit, the response of the 
mechanical network may be predicted; also, if the values of the electrical com 
ponents are varied, the effects of parametric changes in the mechanical system m4y 
be observed. 


system and the 


3.5.1 Elements, Rules, and Nomenclature 


The four basic elements that are used to model linear mechanical syste™® “a 

shown in Figure 3.5.1. The figure shows the corresponding t nslational 4” 

rotational components along with their force or to a e - From top " 

bottom the network elements represent the sameiail ea hehe rotary or 
? 


linear springs, and ro 
4 viscous friction component. 
combinations of them produce a /i 
an independent torque or force genet 





air as follows for the operator 
7 y(t). If Hlax(t) + By(t) 
running friction violate this re 
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Friction 
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F=B (x; — Xo) 
T=B (6; — 6) 


Torque Generator 





Motive 
Force 


Force Generator 


ments of a mechanical network. 


dashpot represents 


Figure 3.5.1 Basic ele 


tary or linear dashpots. Recall that the 
Each of these elements 1s “jinear,” and therefore 


near system. * The final element shown represents 
ator which 1s the motive force for the network. 


ich are mathematically 
ndent variables x(t) 
having Coulom 


"1 | o . 
Linear systems exhibit the properties of additivit 
H, the constants a ane F> 

js linear. 


|= aH{x(t)] + BH[y(t the system > 
lationship and are therefore nonlinea!. 
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The two nodes of the network elements may be interpreted in the follo.. 
manner. The mass of Figure 3.5.1 has the node xi associated With the moti Wing 
the mass, while the node x, is associated with the motion of the Teferene (n of 
that the reference may be fixed or moving). The inertial element hag n ie 
associated with its rotational position and node 8 as its reference, Th ~ 8, 
Spring's nodes each represent a displacement from its equilibrium Position, p< 
their difference times the spring constant defines the reaction force of the gy. 8 
The torsional spring is defined similarly to the linear spring. The Node 
dashpot (viscous friction element) represent the relative velocities of the i 
of the element. , 

Drawing a mechanical network simplifies the writing of a system’s differentia) 
equations. Initially, nodes are defined for each position or angular displacemen; 
with reference positions taken from the static equilibrium positions. Then the 
appropriate element is connected between these nodes so that the ends Of the 
element are located at the nodes that define motion of that element. For example 
inertia elements are connected from the reference node to the node representing 
the inertia’s position, while springs and viscous elements are connected between 
nodes representing the position of the ends of the elements. Torque or force 
equations are written for each node by equating the sum of the torques (or forces) 
at each node to zero. 

Although not considered in detail, nonlinear elements may be included in a 
mechanical network. Since closed-form solutions of networks containing nonlin- 
earities may not be attainable, the most practical method is by computer simulation 
techniques. 


Ne. 


3.5.2 Translational Examples 


The following examples show how a mechanical network may be generated for a 
translational mechanical system. The examples are intended to familiarize the 
reader with the methodology of converting a mechanical system into a mechanical 
network and writing nodal equations. 


EXAMPLE 3.5.1: MECHANICAL NETWORK FOR SPRING-MASS-DAMPER 
SYSTEM 


Figure 3.5.2 shows a mechanical system consisting of a linear spring — 
may be expanded or compressed) connected to a mass that has a Vis 
frictional component between itself and the reference. This may be cons! 
ered as a simple model for a prismatic joint driven by a linear motor. a8 
joint consists of the mass and viscous friction (due to bearings), the 1 4 
models a coupler, and the force the linear motor. Example 3.5.2 shows * 
more realistic model for this same system. The objective is to draw 4 
chanical network to facilitate the writing of the nodal equations. 


. ** , ; ie nce, 
The first step is to identify the nodes of the system. The refere 
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Figure 3.5.2 Spring-mass-damper system. 


node x;, and node x, are identified. Recall that the nodes are associated 
with the positions of the elements. We note that the spring is connected 
between nodes x, and x,, the mass between node x, and the reference, since 
we are interested in the position of the mass with respect to the reference, 
and finally, the viscous friction element between node x, and the reference. 
The friction element 1s connected here because its friction is dependent on 
the relative velocity of the mass and its reference. Figure 3.5.3 shows the 
corresponding mechanical network. 

The node equations for the network are obtained by noting that the 


sum of the forces at each node must equal zero. Thus we obtain the following 
two equations in the Laplace domain: 


node x;: F(s) = K[X,(s) — X,(s)] B51) 
node x: (s*M + sB + K)X,(s) — KX,(s) = 0 (3.5.2) 


F(t) 


| 


i k for spring-mass- 
Mechanical Ground Figure 3.5.3 Networ pring 
(reference node) damper system. 
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Once the nodal equations are written, it 1s possible to ¢ in 
algebraically and write any desired transfer function or obtain a ditt . them 
equation by inverting the Laplace transforms. TeNtia 


EXAMPLE 3.5.2: MOTION OF TWO MASSES ELASTICALLY COUPLE) 


Figure 3.5.4 shows two masses each having a different viscous frictional 
ponent with respect to the surface on which they are moving. The two Om. 
are coupled together by an elastic member. | This System is a more rede 
model of a linear motor driving a prismatic joint. Note that the Mot tle 
a mass and viscous friction associated with it. As will be seen in Chapte as 
the force will be proportional to current, and the acceleration that Gn 
produced will be dependent on all the components. . 

The coupling between the masses is modeled by a spring in Paral] 
adashpot. This is a reasonable model for a physical coupler that is not 
elastic in nature (Section 3.5.3.1 expands on this topic). 

The mechanical network is shown in Figure 3.5.5. Note that there are 
only three position nodes, including the reference. The nodal equations are 
defined as the following differential equations. 


El with 
Purely 


node x,: F(t) = (M,x, + (B, + B,)x, + Kx,) — Kx, — Bk, (3.5.3) 
node x,: (M,x%, + (B, + B3)x. + Kx) — Kx, — Box, = 0 (3.5.4) 


Note that F(t), x,, x,, and their derivatives are functions of time. By com- 
bining Eqs. (3.5.3) and (3.5.4) one may solve for x(t) = f[F(s)], the position 
of the prismatic joint. With this information the settling time of the prismatic 
joint for various applied force profiles may be investigated. 
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Figure 3.5.4 Linear motor driving a prismatic joint. 
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Figure 3.5.5 Network for Fig. 3.5.4. 


35.3 Rotational Examples 


The principles of network analysis are similar for rotational systems, with the 
exception that the nodes are now angular displacements and the nodal equations 
are with respect to torques. Two examples will be considered in this section. The 
«rst jg a single node spring—mass—damper system, while the second is a practical 
model of a harmonic drive transmission. 


EXAMPLE 3.5.3: ROTATIONAL SPRING-—INERTIA-—DAMPER SYSTEM 


Figure 3.5.6 shows a simple rotational spring—inertia—damper system. This 
system consists of a disk connected to mechanical ground by a thin shaft. 
This thin shaft is a torsional spring. A viscous friction, B, acts on the disk 
while the applied torque, T(t), also acts on the inertial disk. The reader 
should compare this to Figure 3.2.12, the torsional pendulum. 

This topology can be used to model a stepper motor (see Chapter 4), 
which is settling at an equilibrium position, or a rotary joint of a manipulator. 
In the latter case, one can assume that the motor-driving the joint is locked 
at some position (this is the mechanical ground in the figure), the torsional 
spring, K, models the stiffness of the servo loop and any couplings from the 
motor to the load, while the inertia disk models the load, and the viscous 
iriction models the bearings of the system. After obtaining the system equa- 
ons, One could investigate the results of a torque disturbance applied to the 
“nd of the link driven by the rotary joint in terms of the change in position, 
the settling time, or other parameters of interest. 

Figure 3.5.7 shows the mechanical network for the system. Note that 
there is only one node besides the reference in the system. This is because 
N¢ are interested in the position of the inertia with respect to the reference, 
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Ch 
a 
D. 3 
Viscous Figure 3.5.6 Rotational] spring- 
Friction B inertia-damper system. 
Reference Figure 3.5.7 Network for spring- 


Node inertia-damper system. 


the spring is connected to the inertia and the reference, and the viscous friction 
is defined by the velocity of the inertia with respect to the reference. Sum- 


ming the torques at node 6, we obtain the following equation in the Laplace 
domain: 


node 6;: T(s) = (sJ + sB + K)6,(s) (3.5.5) 


eee 
EXAMPLE 3.5.4: MULTIPLE-ELEMENT ROTATIONAL SYSTEM 


The following is a model of the harmonic drive component of Section 3.3.1.2 
utilized to drive an inertial and viscous friction load. This models a typ! 
robot actuator—transmission—load. Figure 3.5.8 shows a schematic repre 
sentation of the harmonic drive and its load. In this case the harmonic une 
is represented as an ideal gear train. On its input is an inertia that is dU° . 
the wave generator, which is a component of the harmonic drive- On 10 
Output, we note that there is a spring connecting the actual inertial load 
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cet . 
Harmonic Drive 
rigure 3.5.8 Multiple-element rotational system: harmonic drive with load. 
sae transmission. This is the spring constant that can be observed if the input 


af the harmonic drive 1s locked and the output displacement versus applied 
torque IS measured. The actual harmonic drive exhibits different spring rates 
depending on the load torque. However, to simplify the model we will 
assume a constant spring rate, thus making the spring a linear component. 
This is physically possible if the load torques do not exceed the values that 
change the spring rates. In addition, this particular model does not include 
any of the nonlinear effects found in most gearing. 

The mechanical network is shown in Figure 3.5.9. Note that we have 
‘acluded a block labeled n between nodes @, and 9,. This block is a torque 
multiplier and defines the relationship between torques T, and T,. In ad- 
dition, we Will also have to take into account the positional relationship 
between 0, and 6, as defined by the coupling ratio. The nodal equations are 


given by: 
node 0,: T(s) = (SJug + SBy,.)9,(s) + Ty(s) (3.5.6) 
node 65: T>(s) = K[6,(s) — 93(s)] (323.7) 
node 03: K([83(s) — 82(s)] + (sJ_ + 5Bz)83(s) = 9 (3.5.8) 


T(t) 





Figure 3.5.9 Mechanical network for harmonic drive with load. 
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—_ ; Chap 
The equation that relates nodes 6, and 6, 1s x 


eto 
= T; 6, TR (3 
5. 
Once a set of equations describing the network [such as Egs. ’) 


(3.5.9)] are defined, it is possible to define transfer functions ee . 7 tl] up, 
Variable in terms of another. © for One 


3.5.3.1 Torsional resonance 


In most mechanical systems, the velocities of the moving parts are not 
same since real-world mechanical parts are elastic in nature and Physica] in 
Such as couplers may be intentionally introduced in asystem. Since the ma ey 
and direction of the velocities of the various components may be different 
function of frequency, the system may store a large amount of mecha 
Which results in very noticeable vibrations. This phenomenon is cq 
resonance. 

The model of the harmonic drive transmission presented in Exam 
takes this phenomenon into account. The node associated with the actuator js 
coupled to the node associated with the load by a spring. This type of model is 
called a “lumped-parameter” model since we assume infinite stiffness of all shafts 
other than that represented by the torsional spring and all inertias are concentrated 
at specific places. Many complex systems may be analyzed by these techniques: 
however, when distributed parameters are assumed to be lumped, the Validity of 
the model must be assessed. 

In general, the torsional resonance phenomenon appears anywhere two in- 
ertial loads are coupled by a resilient member, as shown in Figure 3.5.10. Thus 
the use of a coupler in a mechanical system can lead to resonance, and, as indicated, 
most gear trains or transmissions will have a finite stiffness associated with their 
outputs. This stiffness may be due to an antibacklash arrangement or something 
similar to the flexible cup characteristic of the harmonic drive. 

Torsional resonance becomes quite important in the design of high perform- 
ance (i.e., high bandwidth, fast, accurate) servo loops associated with the param- 
eters required by robot manipulator systems. It is a well-established fact that if 
the mechanical resonance frequency occurs inside or near the servo bandwidth, 
the loop’s stability is degraded even to the point of sustained oscillation. 1° 
eliminate this problem, designers may specify extremely stiff mechanical eo, 
nents so as to ensure that the resonance is outside the required servo bandwi ie 
or if the performance parameters may still be met, the servo bandwidth may 
set well below the resonance frequency of the mechanical structure. lop 2 

To further explain the torsional resonance phenomenon, we will devé stem 
simple model for a two-mass—spring system. A network used to model the ace 
of Figure 3.5.10 is shown in Figure 3.5.11. The model consists of a torque § 


the 


, a 


Ple 3.5.4 
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vlodeling of Mec y S ve 


ceo 3° 
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Tit) Inertia Load 
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rigure 3.5.10 System that will exhibit torsional resonance phenomenon 
I « 


ine hich is part of the actuator, the inertia J; which is the load, and a 
qn ined ie allel with a dashpot to model a resilient coupler. The dashpot element 
spring ler represents the inherent molecular damping in the spring material, 

cou ring component represents the finite stiffness of the coupler. Typically, 
oat damping of the coupler is much larger than that associated with the 
e m0 viscous friction of most drives. This damping term controls the shape of 
ester nance response. 
the re the analysis techniques presented in the preceding section, the transfer 
- of the actuators shaft velocity, (1,(s), to input torque is found to be 


0 
while the 


Q,(s) _ sJ, + sB+K 
T(s)  s[sJaJz + sBV, + Jz) + KU, + Jn) 


tion (3.5.10) includes the effects of loading at node 6, due to the coupling 
met load inertia. Note that if the coupling had been assumed to be perfectly 
a ae network would consist of the torque source across the two inertial loads 
nd the corresponding transfer function would be given by 


Q,(s) _ 1 
T(s) sil, 7 J;) 
A careful examination of Eq. (3.5.10) reveals that the numerator consists of 
two zeros which are typically complex conjugates, and the denominator consists 


a Si iP] lex conjugate poles. 
of three poles: a single pole at the origin and a set of comp ite 
Figure 35.12 shows a Bode plot for Eq. (3.5.10). Note the characteristic —20 


(3.5.10) 


(3.5.11) 
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enon. 
Figure 3.5.11 Mechanical network for torsional resonance phenom 


al Systems: Components, Dynamics, and Modeling 


166 Mechanic Chap 
‘3 






a0 AR / denede 





Anti-resonance 
Peak 





cog Fequaney Fite 3-612 Bode lot fo 

dB/decade slope until the sharp notch occurs. This notch is called an “antires,. 

nance’ and is due to the complex conjugate zeros. The peak following the ant;- 

resonance is the “resonance peak’’ and is due to the complex poles. The resonance 

is more damped than the antiresonance and always occurs at a higher frequency. 
Algebraic manipulation of Eq. 3.5.10 yields 


Q,(s) s* + (B/J,)s + (K/J_) 
T(s)  sJ,fs? + sB[J, + JWJaIiL] + K[Ja + Ira x} 


The constant term in the numerator quadratic of Eq. (3.5.12) corresponds to the 
square of the antiresonance frequency. Note that this is an undamped frequency. 
This is the same frequency of oscillation that will occur if the load is disturbed with 
the actuator locked. Referring to Figure 3.5.11, this situation is modeled as a 
short to the reference node from both the torque generator and actuator inertia. 
This is sometimes referred to as the /ocked-rotor resonant frequency and can easily 
be measured in a physical system. Ofcourse, the frequency measured in a physical 
system will include the effects of damping. Similarly, the denominator quadratic’s 
constant term corresponds to the square of the resonance frequency which is also 
the “free rotor and load resonant frequency.” Once again a physical measurement 
will yield a damped frequency, but knowledge of the envelope allows one to extract 
the undamped natural frequency. In addition, it can be shown (see [2]) that the 
damping ratio for the antiresonance is significantly lower than the damping ratio 
of the quadratic factor corresponding to the resonance. Additional information 
on this topic can be found in [2], [7], [16] and [18). 

A common problem in robotic design is that the payload may be variable; 
that is, a robot may be capable of carrying a payload of up to say 25 Ib located 
some distance from its tool plate. If one considers the variations in inertia from 
a no-load to a fully loaded condition, the effect on the bandwidth may be staggerine: 
In addition, anlresonance and resonance frequencies may move considerably: 


(3.5.12) 
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TABLE 3.5.1 MECHANICAL AND ELECTRIca, ANALOG 
S 
Translational Rotational 
Electrica] 

F Force Tr Torque 
y Velocity ® Angular velocity 1 Current 
M_ Mass | J Moment of inertia C Voltage 
K Linear spring K Torsion spring ; Capacitance 

constant constant 5 Reciprocal 
B Linear viscous B Rotational Viscous , Inductance 

friction constant = 


friction constant ~ G Conductance 


I 


3.5.4 Electrical Analogs 


ee) 


As stated previously, an analogy can be made between the components of a me- 

‘cal network and an electrical network. Force and torque are analogs of 
cham while velocity is the analog of voltage. The nodes of the mechanical 
current, that were analyzed corresponded to linear or angular displacements. 
—— to make an electrical analog, one must write the mechanical equations 
Therefor ode velocities. ‘This is easily done by including a derivative operator 
ae i variable and factoring it out of the node’s coefficient. Table 3.5.1 
with roe aula gs between translational or rotational mechanical elements and 
shows 


S. a 
—, aeraar wale be considered the electrical analog of a gear train with 
tran 


ively. 
to voltage and current, respective 
ty and torque analogous . has 
ae ae electrical analogy for analyzing a mechanical a vets 
= ~ the substitutions indicated in Table 3.5.1 and then ana spidenesrtaee ag 
to do 1s arte ‘dent from the table, the electrical components are 
As should be evl 


: ‘fj lysis). 
ich j t simplifies nodal analy een 
admittances Cae hat ne honest s of the electrical components that may resu 
It is possible 


nts no 
impossible to obtain. This prese 
ay be impractical or imp k analysis program 
i eae wissen to be analyzed by hand _ to build the cecteaponditig 
eoteuaneak In the case that one wishes: ato a reasonable 
nerwoe ‘onl on wala techniques can be used to bring values 
network physically, 


range. 
The following example 


OG 
CAL ANAL ‘1 Figure 
EXAMPLE 3.5.5: MECHANIC. ao nical network r aia are 
a. n _ 
Draw the electrical analog for ae —_* values of the yo 
no end “a cmaranitate’, resistor and equa 
trical siieanmmetie are given by 


lectrical 
chanical and e 
oncept of a me 
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s. and inductors: 
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their admittance 
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Figure 3.5.13 Electrical analog for mechanical network of Fig. 3.5.5. 


responding mechanical values. The resultant electrical network js Shown 
in Figure 3.5.13. 


The node equations for the electrical network are given as: 


nodel: I(s) = sc, + (G, + G,) + 4] Vi(s) — (4 + c) V2(s) (3.5.13) 


si 


The corresponding nodal equations for the mechanical network written in 


terms of node velocities (V,(s) and V,(s) corresponding to nodes X, and X;) 
are given by: 


node 2: Ee + (G, + G;) + Alco = iG + G:) Vi(s) (3.5.14) 


node X,: F(s) = fom, + (B, + Bz) + | Vals) = ( + B) V2(s) (3.5.15) 


node X;,: fo, + (B, + B;) + Iv - (A om B,) Vi(s) (3.5.16) 
S 


A comparison of Eqs. (3.5.13) and (3.5.14) with Eqs. (3.5.15) and (3.5.16) 
shows the relationship between the electrical and mechanical variables. 


3.6 KINEMATIC CHAINS: THE MANIPULATOR 


Kinematics is the study of motion without regard to forces or other factors that 
influence the motion. So far in this chapter we have been focusing on indiv! nag 
components and the mechanical concepts and considerations that are requit© se 
design or analyze a mechanical system in terms of dynamics. This section aa 
briefly on the configuration that a manipulator may take and attempts to unl 


| seaeesldes ing 
some of the concepts presented thus far so that the reader can see how everyth 
fits together. 
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Minor Axes 
Le . 
R =revolute joint R c P R R R 
P =prismatic joint 
i dd 1 R” 
Roll Yaw Pitch 
Fixed End 
Free End 
(ground) (tool plate) 


Figure 3.6.1 Joint classification of a cylindrical coordinate robot having a wrist 
with three rotary joints. 


An industrial robot may be thought to consist of a group of “rigid bodies” 
called links connected together by joints. The links are interconnected such that 
they are forced to move relative to one another in order to position the end effector. 
The two types of joints used in commercial manipulators are the revolute and 
Prismatic joints. Revolute joints allow pure rotation of one link about the joint 
“XS of the preceding link, while prismatic joints allow a pure translation between 
links. Actuators are included in the mechanism to enable the motion of the joints; 
“¢ Figure 8.6.1. 
lias links of a manipulator are connected to no me 
ey, 50 that closed loops are not formed. The links an 

™ a kinematic chain which is open at one end and connecte 
T. The end effector or hand is connected to the free en 


Object; ‘ 
ective of the robot system is to position the end effector at 
" Space, 


re than two others (via 
joints of a manipulator 
d to ground at the 
d and the control 
desired location 


170 Mechanical Systems: Components, Dynamics, and Modeling 


4,9 

One way of classifying a robot is by defining the type and orde; aes. 
iat? ‘ndrical robot having a wrist capable Jin}, 
Using this classification, a cylindrica ace 6 idk Of rot ion 
three degrees would be designated RPPRRR. Figure -O. 1 Shows this Classifi, Th 
and identifies the fixed and free ends of the manipulator. ation 

The classification of Figure 3.6.1 says nothing about how the jo; 
connected together: Are they parallel or perpendicular; do their axes int ate 
An additional classification based on the link parameters discussed fully in one 
ee htc aa: current discussion it is sy¢e:.~ aD 

ter 8 clarifies this point. However, for our cur) IS Sufficie 
-~ ; endicular or parallel to att 
Say that the axes of the joints are either perp he One ANOthe; 
In addition, typically, the first three joints position the end effector iN spar. 
while the last three joints are used to orient the tool. An Obvious Physica 
consideration for the configuration of a manipulator 1s that if the first three 
joints are to position the end effector in space, we would like them to be able 
to move in three-dimensional space. Therefore, configurations CONSIsting of 
joints that do not permit three degrees of freedom are not used EXCEPt in the 
case of special manipulators such as a SCARA, which intentionally has only ty, 
degrees of freedom by its first two joints (major linkage) and depends on rigidity 
in the z or vertical direction as one of its unique characteristics. Recall that 
the degrees of freedom of a system depend on the number of variables o; 
coordinates that are needed to describe its position. If one considers the Dos- 
sible combinations of R and P joints for the first three links and eliminates any 
that produce redundant motions, there are only 12 useful distinct configurations 


os sons meee Prismatic joint with its axis in plane of the paper 
| ql | Prismatic joint with its slider perpendicular to plane of paper 


Revolute joint with its axis perpendicular to the plane of the paper 


og Revolute joint with its axis in the plane of the paper 


Figure 3.6.2 Graphic symbols for kinematic c 
Society of Manufacturing Engineers. 
ISIR Conference Proceedings. ) 


hains. (Reprinted courtesy of . 
Copyright © 1983, from the ROBOTS 7/13 
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Jointed 
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Figure 3.6.3 Graphic representation of 12 useful major linkages. (Reprinted cour- 
tesy of the Society of Manufacturing Engineers. Copyright © 1983, from the ROBOTS 
7/13th ISIR Conference Proceedings.) 


“Wola total of 36 [11]. Figure 3.6.2 shows graphical symbols used to depict 
ints, and Figure 3.6.3 shows the 12 useful major linkages. 

: ot in Fi . Note 
th: Some possible configurations for the wrists are shown In Figure “<—_" a 
‘LiL is possible to have less than three degrees of freedom in 4 WT” 


| ly wi iderably less 
han robot applications may be performed satisfactorily with considerably 
dn six ish I | | 
IX degrees of freedom (or joints). a volume” in which 


© Kinematic structure defines a “workspace ; are more suited than 


Of can position itself. Some kinematic configuration 


the rob an 
™ aces which may 
"8 for particular tasks. Figure 3.6.5 shows the worksp 
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3 Dof 


(‘Puma 560” wrist) 2 Dof 
(“‘Maker 110” wrist) 


Figure 3.6.4 Some possible wrist configurations. 


accessed by the major joints for some kinematic configurations. The Possibilit 
exists that some points in the work volume may be addressable by more than = 
set of joint configurations; this is typical in a jointed arm such as the PUMA 
With the addition of the wrist axes, we add more degrees of freedom and now 
besides being able to position the end effector at a point in space we have the 
ability to control its orientation. Besides multiple addressing of points, some points 
and orientations in a robot’s work volume may be unachievable. Ideally, if the 
manipulator is able to position itself to an arbitrary point in Space, the tool should 
be able to be oriented along any radius pointing inward to an imaginary sphere 
encircling the point. Unfortunately, due to physical limitations of the ranges of 
joints and problems such as joints not being able to pass through themselves, the 
ideal case is not attainable. 

In addition, it is important to note that the control Strategy of a robot may 
require complex motions in three-dimensional space, and that some kinematic 
configurations may have easier Cartesian-to-joint solutions than others. Finally, 
a major consideration for servo response is the stiffness of the entire structure: 
Prismatic joints are inherently stiffer than rotary but may not be able to give the 
manipulator the dexterity it needs. | 

By now the reader should be able to visualize how the devices discussed " 
Section 3.3 can be used to implement rotary and prismatic joints. Of course, go° 
mechanical design techniques must be used to ensure that the components as 
handle the loads due to the payload and forces exerted by the mechanism. d 
kinematic formulation does not consider the weights or inertias of the links a 
the actuators for the joints that may be housed inside the links. In additio” 
link is perfectly rigid, nor do all joints behave ideally. Thus the robot manipula! 


ities 
must be analyzed in terms of its dynamic properties and component nonlinear! 
as well as its kinematic properties. 


Sec. 3.7 End Effectors 





reall 
(a) Rectangular (b) Cylindrical 








(c) Spherical 


Figure 3.6.5 Workspaces for some kinematic configurations. 


€7 END EFFECTORS 


An end effector is the term used to describe the tool or device attached to the end 
of the wrist of a manipulator. The end effector itself may be the complete payload 
of the robot, or it may be a mechanism used to hold one or more parts. As stated 
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ATT pee 
Br 


vie 
ectives Of robot control is to | 


| ; posit 
n space by controlling the po ON th, 


previously, one of the major OP} | 
Sitic * Ong 
if} Of Cah , 


effector al some desired location 


the manipulator’s joints. 


commercial devices such as pneumatic »,. 
End effectors range from co PACUMAtic pr ke 


} arc welding < Rpg, 
special tools for applications ranging i  ealaton roe en Painting 1, 
handling of silicon wafers In a cort ase ssually seisteadiiedk tho, € 10 the fn 
applications of robots, end effectors a eee soli aa teas healt ‘pp, 
cation and may include additional wa pea vocitions asi devi 
mechanical linkages that can be we oe , s. They may be 
tifunctional; that is, the same too] may . 


ed to handle a part as it changes 

' 1c ov? Mane 

during a machining OF assembly process. It Is also not uncommon for a grip. 
to be designed for multiple 


-part pickup in lieu of a single part. This may actu 
be necessary to cost justify using 4 robot if the cycle time of manipulating ; ing 
part does not provi 


de the needed throughput. | 
When considering the design of the end-of-arm tooling for 4 manipulats, 
certain parameters of t 


he manipulator and the surrounding environment of th, 

workcell must also be addressed. The end effector itself has weight and moment; 
of inertia; thus these properties, along with the weight and shape of the payload, 
must be considered to ensure that the specifications of the robot are not Violated, 
The configuration of the parts being handled is quite important. It is imperative 

that the parts be consistent (within their tolerance range). It is really not fair to 
expect a robot end effector to be capable of handling anything that comes in front of 
it. If it was designed to pick up cubes with sides of 1 in., it may not be capable of 
de. Since the piece parts on which the gnpper must 


working with cubes % in. on a si 3 pper 
operate may vary (based on acceptable manufacturing tolerances), the design of the 


end effector should be capable of functioning continuously within the normal level of 
variations encountered in a manufacturing environment. 

The end-of-arm tool not only has to interface to the robot, but must not 
interfere with any of the peripheral devices in the workspace. It may be necessary 
to orient the end effector a certain way when using it to insert a part into a machine. 
In fact, it may not be possible to have the end effector mounted directly on the 
tool plate of the robot since the opening to the machine may not be large enough 
to accommodate the actual end of the robot. In this case, very long thin fingers 
may be used to hold the part so that the end of the robot and the actual mechanic 
gripping mechanism do not enter the machine. Of course, one must ensure that 
the use of long fingers to hold a part does not introduce moments beyond the 
specification of the robot. 

__ When robots are used for such operations as insertion, that is, joining par’ 
with close mating tolerances, accuracy becomes a very important parameter: This 
is sometimes referred to as the peg-in-hole problem. If the parts are off-center 
pd and one can easily visualize that it is impossible to insert one nes 
there ig some ce a chamfer on one or both parts may not work un 

pliance between the two parts. Compliance may actually be 


provided by the manipulator itself since it is not infinitely stiff; however. if this 's 


* 


t 


Effectors 
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gill not sufficient, a remote center compliance (RCC) 
ihe tool plate and end effector. The RCC provide 
setion 0 allow the close-fitting parts to be mated. 
jetail in Section 3.7.2. 

In today’s automated factories, reliability is of par 
reliability decreases with increasing complexity, it is better to try to keep the end 
affector simple in both Its design and function. One may be able to design a 
sripper to perform multiple tasks; however, this may be expensive to design or 
purchase and may prove costly to maintain. If possible, modification of the parts 
or process may actually simplify the requirements of the end effector, making a 
simpler and more reliable system. 

In addition to gripping a part, the end effector can include a sensor to de- 
termine if a part Is present. The addition of a simple sensor can make a gripper 
a relatively intelligent device. Consider, for example, a simple gripper that has a 
sensor in it which tells if there is something between its jaws. This could be as 
simple as a light and phototransistor. If the robot is commanded to go and get a 
part, the manipulator will position the tool to the correct spatial location and then 
check the gripper’s sensor before closing the gripper. If the part is present, the 
gripper is commanded to close and the cycle proceeds; however, if the part is not 
present, the robot can then take some predefined action based on this exception 
and perhaps prevent other machinery from cycling without a part. 

More sophisticated end effectors are also possible that include such features 
as servo-controlled axes with force control, and sensors to measure the dimensions 
or weight of an object. Chapter 5 discusses these sensors in detail. Inthe following 


sections we explore some gripper configurations and the remote-center compliance 
device. 


device may be used between 
S the necessary give or wrist 
[his device is described in 


amount importance. Since 


3.7.1 The Gripping Problem 
There are essentially three classifications of grippers [9]: 


I. Those that come in contact with only one face of the object to be lifted and 
use a method such as vacuum, magnetism, or adhesive action to capture the 
object. 


2. Those that use two rigid fingers to grip an object. This type makes contact 
with the object at two specific points and may or may not deform the object. 


3. Those that deform and attempt to increase the contact area between the 
gripper and object. This type includes multijointed fingers or a device op- 
crating on a principle similar to a balloon being inflated inside a glass. 


_ These three classifications are referred to as systems using unilateral action, 
bilateral action, or multilateral action [9]. Figures 3.7.1 through 3.7.3 show ex- 
‘mples of each of these systems. 

Of course, certain considerations must be made in using each of these devices. 
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Figure 3.7.1 End effectors with unilateral gripping action. 
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In the case of unilateral action, the end 


the part as well as picking it up. If a vacuum tool is used the vacuum may a 
to be purged with air to release the Part; otherwise. if ihe seal between the pe 
and vacuum cup is sufficient, the part may stay on the tool even when the vacuum” 
is shut off until some external force Overcomes the residual vacuum. i 
considerations exist when using an adhesive or magnetic approach. In fact, it ™ 
be necessary to have another device ‘‘kick”’ the part from the pickup tool. 
For bilateral action, it may be necessary to include a material such as 
of rubber on both points of contact to increase the coefficient of friction; oth 


effector must also be capable of releasing 
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Figure 3.7.2 End effectors with bilateral gripping acti 
action. 


the part may fall out of the gripper. The implementati : 

‘avoke such devices as rack and pini €mentation of bilateral syste 
| ' and pinions OF various mechanical |i ystems can 
the required motions. Typically, bilateral devices are bi al linkages to achieve 
ther opened or closed. For this si inary In nature, that is 
el r this simple case, a pneumatic 
used. The more sophisticated case of a parallel-jaw devi a - commonly 
variable force or at defined distances would probably alia me of. pra — 
as a servo-controlled rack-and-pinion device (see Figure 5.10.1) such technology 
Implementation of multilateral devices uses such technology as pneumatics 
to inflate and deflate long thin bags which can articulate a joint, wires that stretch 
function of electric current running through them, or very com- 
This particular type of gripper is the subject of 
no commercially feasible “‘three-fingered” gnpper is 


or compress as a 
plicated mechanical systems. 
current research, but to date 


available. 
An interesting implementation of a multilateral gripper is shown in Figure 
fluid-filled chamber to force the outer layer 


3.7.4. This particular system uses 4 
to conform to the part in the jaws. Although the multilateral system looks very 
inviting, one must also consider some of the problems associated with the control 
of these types of devices. For example, if we consider an implementation similar 
to that of Figure 3.7.4, one apparent observation 1s that if the device —s 
“inflate” uniformly, it can cause the part it is attempting to capture to — a a 
may be an undesirable side effect. This simple thought ie mage oo a n 
realize the sophistication of the human being who is capable of PItst's 


irregular object and not causing it to rotate. 


evices 


3.7.2 Remote Center Compliance D | 
quiring 
hole. 


If the 


r applications re 
fa peg into 4 
k can be. 


monly used fo 
the insertion O 


e devices are com 
led simple fs 


ts, for example, 
difficult this so-ca 


Remote center complianc 
the assembly of close-fitting Pat 
A little thought can show how 
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Figure 3.7.3 End effectors with multilateral gripping action. 


centerlines of the peg and hole are not coaxial, the parts will not mate. ee 
distinct possibilities arise. The first is the case of the centerlines being gee 
but not coaxial. This is a translational misalignment. The second 1s weal ligt’ 
where the centerlines intersect but are not parallel. This is a rotationa eet <j- 
ment. Of course, both translational and rotational misalignments ca” sai 
multaneously. cial’ 
Consider that we have a rotational misalignment (i.e., a Pes goes pe 
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Figure 3.7.6 A remote center compliance device. 


in-hole problem; this involves “pulling” the peg into the hole rather than Pushing, 
The pulling allows the peg to rotate and align itself rather than jam against the 
hole, as in the case of pushing. 

Remote center compliance devices (RCCs) solve the peg-in-hole problem by 
effectively causing the peg to be pulled into the hole, as depicted in Figure 31250, 
The RCC device provides the ability to compensate for both translational and 
rotational errors. The rotation is about a point called the center of compliance or 
elastic center. This center is a point that is remote from the unit. Figure 3.7.6 
Shows a typical RCC device. This device consists of two parallel plates which are 
Separated by two rigid rods firmly attached to one plate but with a ball joint on 
the other. In addition, three elastic members are also placed between the plates 
which keep them separated and parallel. The rods and plates are arranged so that 
one plate is fixed and the other one has limited rotation and deflection. 

Figure 3.7.7 shows the result of using an RCC device to insert a peg into a 
chamfered hole. ‘The compliant center is located at a point on the peg since by 
definition it is remote from the RCC device itself. In the case of lateral error (as 
shown in Figure 3.7.7a), the axial force exerted by the peg on the chamfer causes 
a lateral force to be applied to the peg. This force applied to the elastic center 
will cause only a translational motion. This horizontal force causes the peg '0 
translate into the hole by causing the RCC device’s bottom plate to move parallel 
to the top plate. If the axis of the hole is not parallel to that of the peg as shown 
in Figure 3.7.7b, the peg will partially go into the hole and jam. Two points of 
contact are made, one by the leading edge of the peg and the other by the edg¢ 
of the chamfered hole. These two points of contact define forces which in turn 
generate moments about the compliant center. A rotation about this compliant 
center will cause the peg to rotate and line up with the hole. In this case !° 
plates of the RCC device are no longer parallel. 

The remote center compliance devices that we considered are passlv 
nature. However, it should be noted that it is possible, although perhaps not cost: 
effective, to implement this concept USINZ Servos. sensors, and some type of mec! 
anism. 


e 10 


3.8 Resolution, Repeatability, and Accuracy —_ 
| ANipulator 





181 






Contact 
Force 


(a) 


Figure 3.7.7 RCC for inserting a peg 
into chamfered hole: (a) insertion with 
laterial error; (b) insertion with rota- 
tional error. (Courtesy of J. Rebman 
(b) and Lord Corporation, Cary, NC.) 





3.8 RESOLUTION, REPEATABILITY, AND ACCURACY 
OF A MANIPULATOR 


The terms resolution, repeatability, and accuracy are used by ropot eae : 
tc define the positioning capability of their manipulators. ed sce iugiis 
no standard test that all robot manufacturers perform to aaa ry pcos depend 
bers. This problem arises from the fact that repeatability weet direction of 
On 4 great many variables, including payload, velocity, tempers 


it sification hold 
travel, stiffness of the arm, and so on, Additionally, does the speci 


easurement 
: ; , 3 a ¢ move? Was the m 
lor 4 single joint’s motion or for a multiple joint sed to obtain the data: 


, was 

in three dimensions or one? What type of soe ‘ts performance or a noncon: 
One that contacted the robot and perhaps affecte i vaio Cartesian motions? Is 
lacting sensor? Is resolution defined for joint we 

the resolution the same over the entire workspace : 
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By now the reader should have an appreciation of some Of the 


effects that can cause differences in robot positioning such as mecha 
and the nonlinearities of gearing, to name a few. _ These combined wit Ctlons 
error and computations can greatly affect the positioning ability of the t S€ngo, 
robot. The definitions we will use for accuracy, repeatability, and resolut E the 
based on [17] and provide a good model to account for contributions fro N are 
chanical. sensor, and computational effects. M the. 


To begin our discussion, consider a mechanism that moves in One dimene: 
parallel to the paper. Control resolution will be defined as the smallest increme. 
change that the control system (usually a servo) can distinguish. Ip addition ie 
assume completely ideal conditions, such as no deadband, computational Problem 
OT sensor errors. Figure 3.8.1 shows a series of equally spaced points representin , 
where our mechanism may be commanded to go; the distance between these Points 
is the control resolution. The control resolution can be computed by dividing the 
total distance that can be traveled by the total number of discrete POsitions that 
the mechanism can resolve. If we include the effects of mechanical inaccuracies 
Or sensor errors, we find that instead of the mechanism stopping on each point 
associated with the control resolution, there is a zone about the ideal point where 
it may stop. This has been shown as a symmetrical zone in Figure 3.8.1: however, 
depending on the implementation of the mechanism, it may be biased more in one 
direction than in the other. 


Spatial resolution is defined as the worst-case distance 
between two adjacent positions, as illustrated in the figure. Resolution is important 
for both record-and-playback applications and o 


ff-line programming. Essentially, 
it defines the ability of the manipulator to be able to reach positions close enough 
during initial training or defines the smallest move that the robot can make, which 
affects the ability of the manipulator to move in nonjoint spaces such as Cartesian 
coordinates. 


Accuracy is a measure of the ability of a mani 
point in space, previously never approached b 
extremely important for off- 


; Chan; 
nical def] Mica 


pulator to approach an arbitrary 
y the manipulator. This concept is 


line programming, where the coordinates that define 
the position that the robot is to move to are obtained from a data base. Figure 
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Figure 3.8.2 One-dimensional representation of accur 
acy and resolyt; 
Olution. 


38.2 shows an arbitrary position, X in space, along with th 
sasitions and the mechanical inaccuracy about each sittin — resolution 
- commanded to go to the position designated by X. it win ; - —— 
-josest to X as defined by the control resolution, point A in Figure 3 82. rt srleay 
since there are mechanical inaccuracies in the system, the actual lee SUWeNED, 
‘om is somewhere in the ‘“‘zone” | cation of the 
mechanism 1S 5 € “zone” about A. Accuracy is then taken as th 
worst-case distance from the arbitrary point to where the manipulator “ : 
ositioned. Examination of Figure 3.8.2 indicates that if one were to define oe 
worst-case value for accuracy, it is equal to one-half the spatial resolution. Ob- 
viously, some points would have a smaller value, but this figure is the worst that 
the manipulator could be off from a commanded position and should be the accuracy 
figure quoted in the specifications. 

Accuracy is usually divided into local and global. Global accuracy defines 
the accuracy over the entire workspace of the robot, while local accuracy is con- 
cerned with accuracy in the neighborhood of specified points. One of the con- 
tributing factors to global accuracy is axis misalignment. The kinematic model 
assumes that axes are positioned ideally; however, the manufacturing process in- 
cludes tolerances for mechanical assemblies, and therefore axes thought to be 


perpendicular may ‘1 fact be off and cause considerable errors in certain regions 


of the workspace. | a 
Repeatability 1s defined as the ability of a manipulator to reposition itself at 


a position to which it was previously commanded. Repeatability 1s ne “A 
many factors; by the strictest definition, measurements must be eee ro 
same payload, velocity, acceleration, direction of approach, and am ieee 7 7 
ature. The repeatability specification determines whether merece “ dere 
able to reach previously demonstrated positions close enoug an itisl position 
second and succeeding times during a repetitive operation. her case, the 
may be demonstrated, or obtained from a data base, but on ‘he positio n. Re 
nipulator’s control will associate a control resolution point ri vill position itself 
member that due to mechanical inaccuracies, the mean vv joved away and 
somewhere in the zone associated with the poms. : a ‘ the same position OF 
then commanded to go back to this —_——. , acal point. The distance from 
another position in the zone associated fol it 7 it attained on the second try 
the initial position of the manipulator to the posit 

IS 4 measure of its repeatability. Figure 

If one were to command the manip : 
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Figure 3.8.3 One-dimensional representation of repeatability. 


great many times and plot the position that the manipulator attained on each t 
you would obtain a locus of points that fell within the mechanical inaccuracy zone. 
This is a measure of the repeatability of the manipulator. One way of defining 
repeatability is to bracket the hits on either side of the zone and measure this 
distance. Note that the locus of hits may be shorter than the distance defining 
the mechanical inaccuracy zone. Half of the bracketed distance is a measure of 
the repeatability. 

Long-term repeatability is concerned with the repeatability of the manipulator 
Over a large time frame (on the order of months). In general, long-term repeat- 
ability is influenced by factors such as mechanical wear. 

Short-term repeatability is associated with changes that occur over a short 
time, typically hours or shifts. It is concerned with the changes in performance 
as the robot “‘warms up” or as the ambient temperature changes during the day. 

The National Machine Tool Builders’ Association (NMTBA), the association 
for manufacturing technology, has released definitions for both linear and rotary 
accuracy and repeatability. To provide standardization, these are based on a 
standard temperature of 68°F and are specified for only one axis at a time. The 
NMTBA definitions are based on statistics and are equivalent to the definitions 
mentioned above. The definitions of unidirectional and bidirectional repeatability 
are given as follows: 


1. Unidirectional repeatability shall be defined as the expected dispersion on 
each side of the mean resulting from a series of trials when approaching any 
given point under the same conditions. 


2. Bidirectional repeatability shall be defined as the expected dispersion 0 = 
side of the mean resulting when the approach to any given point 1s pr 
grammed from both directions in a series of trials. 


shows 
rials 
the 


Figure 3.8.4 shows the unidirectional repeatability, while Figure ae? 
a possible definition of bidirectional repeatability. Typically, the number © 
at any given point is taken as seven in the NMTBA formulas. In addition, 
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Figure 3.8.4 NM 
unidirectional re 
duced with the 
the association 
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TBA definition of 
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for manufacturing tech- 


of the data assuming a Gaussian dis- 


point is defined as being the sum of 


© mean and the target at any point 
plus the value of the dispersion at that point which gives the largest absolute sum. 


Figure 3.8.6 illustrates this definition. If enough data points for both accuracy 
and repeatability along a given axis of motion are obtained, a plot can be made 
showing the distance along an axis versus the accuracy at each point. Figure 3.8.7 
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A haar 
+ ny 
Evaluating Positioning Positio 
n Target 
Maater Reauite (suitably corrected) 


Measure Hiatogram 





Distance along axis —————--——— 


A, = AX, > 30), 
Ay = AX, + 30, 


Definitions are as follows: eee 
accuracy value at any point when using a programmed bidirectional approach 


A, = accuracy value at any point when using a programmed unidirectional approach 
4X, = difference between mean and target (a perfect master measure) when using a Programmed 
bidirectional approach; a signed number 
AX, = difference between mean and target when using a programmed unidirectional approach; 
a signed number 
30, = expected dispersion on each side of mean when using a programmed bidirectional approach 
30, = expected dispersion on each side of mean when using a programmed unidirectional approach 


NOTE: Length units must be consistent, i.e., inches, thousandths, etc. 
In the event the choice of unidirectional or bidirectional programmed approach is not stated, the 


unidirectional approach is assumed to be specified. 


Figure 3.8.6 NMTBA definition of accuracy. (Reproduced with the permission 
of NMTBA, the association for manufacturing technology. ) 


shows a plot of the position of an axis versus the accuracy at any given point. The 
envelope defines the worst-case system accuracy, and a safety zone is included to 
define the specified accuracy of the mechanism. 

So far our discussion on accuracy and repeatability has been based on a single 
dimension. The remainder of the discussion will focus on some of the consider- 
ations for defining multidimensional repeatability and accuracy and should serve 
to give the reader some insight into the many-faceted problem of coming up with 
a set of standard specifications. | 

Most commercial manipulators have discrete control resolutions for each ol 
their axes. That is, the smallest move that the axis can make is defined by ' 
contro] resojution. ‘This gives rise to workspaces in which the tip of the manipulator 
can only be positioned at the intersection of the discrete control positions. Figure 
3.8.8 shows the incremental workspace for both a Cartesian and cylindrical robot 
system consisting of only the three major axes. In either of these two workspace 
the only positions that the mechanism may attempt to go to are the points whit 
are the intersections of the solid lines. Thus there are only certain positions ! 
space that the robot may actually attain, 
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Figure 3.8.7 NMTBA definition of accuracy versus position for an axis. (Reproduced 
with the permission of NMTBA, the association for manufacturing technology.) 


For the case of the Cartesian workspace in Figure 3.8.8, if we assume that 
each intersection point 1s attainable without any error, then the worst-case accuracy 
of this system may be defined to be: 


dx\” dy ° dz\" 
a= |(€) +(%) +9) 3.8.1) 
Equation (3.8.1) says that the worst-case distance from where we want the ma- 
nipulator positioned to its actual position (i.e., the intersection of the solid lines) 
is the distance from the center of the cube to one of its corners. Note that in this 
case, it is possible for the positioning algorithm to choose one of eight possible 
positions. 

The cylindrical workspace has severe limitations on being able to reach certain 
points defined by Cartesian coordinates. As the r dimension increases, the actual 
spatial displacement in the 6 direction increases even though the control resolution 
of the ® axis remains fixed. Thus one may generalize that the accuracy of a 
‘ylindrical manipulator is better with the r axis retracted than when it is extended. 
- hee to this concept of positioning granularity the mechanical inaccuracies 
me : the control resolution into spatial resolution and we may define a solid 
manipulate each composite control point of where the actual position of the 

: depen i The actual position of the manipulator in this solid region would 
th On various factors. The distance from the center of this region to 


: ) | ege . 
ies farthest away from it defines the worst-case repeatability for this three- 
“"Onal figure. 
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Figure 3.8.8 Incremental Cartesian and cylindrical workspaces. 


Another problem that comes into play in defining both the accuracy and 
repeatability of the control system depends partially on how computer control is 
implemented. When the servos cause each axis to move so as to reach a final 
destination, there is sometimes a tolerance associated with the difference from the 
desired final position and the actual final position of each joint. This tolerance IS 
necessary to account for settling-time considerations. Thus the computer may 
consider that the manipulator is positioned at the designated set point if all the 
axes are within, say, +8 encoder pulses of the desired final position (see Chapte! 
>). Some axes may be exactly on target, others off by one or two pulses, 4” 
others at the tolerance limit. Since the control to each axis is still active after the 
computer acknowledges that the axes are within an acceptable tolerance, the ee 
nipulator’s control system slowly forces cach axis to move to its final position with 
zero error. The time between the first report that the manipulator is within the 
tolerance range, and when it stops moving may be on the order of a few secon 


Forces Encountered in Moving Coordinate Systems 
ec. ~" 

5 rements are made on a manipulator or ; 
ite tant t0 know “when” the measurement wa 
+t i8 ae amics in addition to the actual value of th 
motion snsider. for example, the Following scenario, which may cause some prob- 
, robot application. Initially, the robot is “taught” by demonstration a 

jems I ‘in space. When the robot is commanded to return to that position, it is 
jocatto! se off by an amount less than or equal to the tolerance. However if a 
foun . _acluded before the measurement Is made, the distance from the saiitial 
delay to the location the manipulator reaches js reduced. This illustrates 


i golerancing” effect on the repeatability of a manipulator used in a playback 
th 


: easu 
us ! 


S made with respect to the 
€ specification. 


nally one must consider the effects of the measurement methods used to 
obtain data for repeatability and accuracy. Although an electronic “dial indicator”’ 
-an be used for some measurements, the fact that the Manipulator touches the 
measuring device causes a reaction force and damping thereby generating errors 
1 the data. A three-dimensional noncontact sensing device such as a laser or 


capacitance-type Sensor provides the best snapshot of the robot’s positioning per- 
formance and can give a “feel” for settling time. 


39 FORCES ENCOUNTERED IN MOVING COORDINATE SYSTEMS 


So far, the forces and other variables describing motion that we have discussed 
have all been assumed to be in an inertial reference frame. One of the problems 
in sizing the components of a robot or ensuring that a robot can properly do a task 
involves estimating the forces or torques that will be applied to the various joints’ 
actuators. Recall that to move a jointed manipulator’s end effector in an arbitrary 
straight line may require very complex motions of the joints that make up the 
kinematic chain. The forces or torques required to accelerate each joint include 
contributions from reflected inertias, gravity, friction, and the effects of Coriolis 
and centripetal forces. The following discussion is modeled after [15]. 

Figure 3.9.1 shows two coordinate systems, XYZ and xyz. We will assume 
that system XYZ is fixed and is our reference; that is, all forces and positions will 
be defined with respect to this system. System xyz’s origin is displaced from the 
lixed system and vector R describes this translation. Vector R is a function of 
(ime, since we will assume that the relationship between the two coordinate systems 
‘Snot fixed. Thus R and R denote the velocity and acceleration of the origin of 
the moving coordinate system relative to the fixed origin. ae . 

P ie i" fH wermore, assume that system xyz is free to rotate — its poplar 
may . . ae as a particle or a fixed point on a ppc rego ms an 
Sie 7 csent the center of gravity of the manipulators payloaq. 

vector from the origin of xyz to P. 
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Z 





Figure 3.9.1 Moving coor 
frames. 


dinate 
It can be shown [15] that the total forces (as seen in the fixed s 
act on the particle P can be represented by the following equation: 


F = MR + Mr + Mo x r) + 2M(w X *) + M(w X (@ x r)) (3.91) 


All the quantities in Eq. (3.9.1) are vectors, with the exception of M, which 
represents the mass of the particle at point P. The quantity @ is the angular 
velocity of the xyz system with respect to the fixed system XYZ. The lett side of 
Eq. (3.9.1) is the resultant of all forces acting on the particle as seen by an observer 
in the fixed system. The first two terms on the right of the equation define the 
force on the particle due to its mass and acceleration relative to the fixed frame; 
the third term is sometimes called linear acceleration and typically goes to zero 
unless there is acceleration between the fixed and moving frames. The fourth 
term on the right of Eq. (3.9.1) represents the Coriolis force, while the last term 
represents centripetal force. 

As shown by Eq. (3.9.1) there are many possible contributions to the total 
force required to accelerate a particle. This concept of a moving coordinate system 
(i.e., frame) may be used to model the forces or torques required to be produced 
by the actuator of a joint. In fact, one May group several joints and links together, 
such as those composing the wrist and define the forces acting on the link on which 
they are ultimately connected. Since each joint of a manipulator typically possesses 
one degree of freedom, the equations may simplify if frames are chosen correctly. 

It is important to realize that it may be quite impossible to model accurately 
the actual performance of a Manipulator this way; however, it may be sufficien! 
to recognize that these types of forces exist and approximate their magnitude af 
as to get an idea of the “headroom”? necessary in choosing an actuator sO that the 
effects of these components do not degrade the performance of the robot. 

In Chapter 8 we provide the basis for the mathematics used to describe 


position of the manipulator’s end effector; with reference to a fixed coordina 
system. 


ystem) which 
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an ANALYSIS OF A MANIPULATOR 


n our analysis, we have considered ¢ 


point |} 
Up <9 we have assumed that the link driven by a ic; 
; "sociated with it, had frictional terms (both Joint actuator had an inerti 

mass” been affected by the f th linear and nonlinear ; REEMA OF 

ay have y orce of gravity. Addit; nlinear in nature) 
"have been affected by subsequent links, we a ) ditionally, while the ait 
moi or maximum value. There ine be u d approximate it in terms of 
qm said occur if other joints and links moved ake of other reactive forces 
jator was based solely on worst-case seiuthers bn tt Thus the sizing 
neleration force), and the effect of gravity. Unfortunatel th —— ao 
forces which can occur if joints move simultaneously me ar are other reactive 
izing 0 the actuator and the headroom needed in the me may influence the 

One method of analyzing the complex nature of the sotoel ad _ 
nge’s equation. While this treatment will reduce - ks chain Is to 
ethod for an easier formulation of the problem. L 0 ewton S law, it 
5 based OD the concept of generalized coordinates and semeselaed fee $ equation 
eralized coordinates ID terms of robotics are typically angles pin pen — 
revolute and prismatic joints respectively. Generalized forces beco ree ror 
or forces associated with the joint actuators. Asin any physical syst me “. torques 
of generalized coordinates needed to describe the position of a siete ae numer 
of degrees of freedom of that mass. Since this method is based on a ; renner 
particles OF systems of particles, the modeling technique is based nae 1 ir : 
parameter model of the manipulator with point masses representing the aa of 
inks and their internal components with the point masses located at the center of 


pravity of the link. 
The Lagrangian, L, is defined as 
potential energies of all of the particles 


coordinates. 
L=E,- £, (3.10.1) 


em with both conservative (derivable from a potential 

rvative forces is given as 

= : a a = (3.10.2) 
ot \04i 84; 

te associated with the 

he generalized forces 


he dynami 
€ dynamics of a single axis. 


{Cc 
ur act 


utilize Lagra 
rovides 4 1 


the difference between the kinetic and 
of the system expressed in generalized 


Lagrange’s equation for a syst 
such as gravity) and nonconse 


F; 
Where q; is the generalized coordina force F;. As mentiones 
become torques, T, an 


b ; 
— in the case of rotary joints, t ae 
generalized coordinates become angular displacements, 9. For prismatic joints 


. . 
: a forces are F, and the generalized coordinates correspond to linear 
ed acements. It is important to note that the linear displacements are not nec- 
arily in Cartesian coordinates; they are he axis of extension. 


nian ur objective in this section is to give nsight we this ey 
que but by no means provide the ultimat e will presen 


typically along t 
the reader some! 
e discussion. 
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° odd 
Axis of 
Motion 
ass of M at 
<—— Center of Gravity 
Figure 3.10.1 Single prismatic join; 
working against gravity. 
O 


extremely simple systems in order to define terminology: . References are provided 
at the end of this section for those who wish additional information. 

The easiest way to gain an understanding of Eqs. (3.10.1) and (3.10.2) is to 
use them to analyze a single joint manipulator as shown in Figure 3.10.1. This 
“manipulator” consists of a single prismatic axis that can move UP and down against 
gravity. As can be seen from the figure, there is only one coordinate, z, needed 
to define the position of the manipulator. The kinetic energy can be expressed 


as: 
E, =2M ia (3.10.3) 
while the potential energy is given as: 
E,=Msgz (3.10.4) 
The Lagrangian becomes: 
L=4M27-Mez (3.10.5) 


and the force directed along the positive z axis needed to move the mass for some 
given acceleration is given by: 
F,=Mz+Meg (3.10.6) 


These results are the ; 
oe a nt same ones that would be derived using Newton's equations. 
ey state vat the force needed to accelerate the mass upwards 1s equal to the 
sum of its weight and its mass times the desired acceleration 
ssid teen sane ai dale has not produced any more information than We 
ine ith Our previous analysi jaet 
» ¢ TP. ae ysis techniques. Now let us cons! 
a more complicated system. Figure 3.10.2 shows ger tic of a CY ' 
ae robot based on Figure 3.4.10. Specifically oe al 7 in whi 
and r axes move is shown. Note that i : , the plane 
| : lat in this cas i nfluenc’ 
of grav | seatare the Mae ase, neither ax r the 10 
For this nn vee os rn potential energy term of the La 7 san equal .. 
| ve vs fae ie generalized coordinates chose ; agrangl 
sponding to 1€ position of the rotary joint and n will be the angle ©’ | the 
location of M,,. ‘The point masses, M, and the length, r, correspond! & 
, M, and Mz are the masses for the Jinks 
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Mp 
(Mass of link carried 
by prismatic joint) 


es Prismatic Joint 


(Mass of link carried 
by revolute joint but 
excluding mass 
of prismatic joint) 


Figure 3.10.2 Plane of motion for the r 
and 6 axes of a cylindrical coordinate 
Revolute Joint manipulator. 


sociated with the rotary and prismatic joints respectively. The kinetic energy 
associated with mass M, is given by: 


Ex =} M, fe. Q? (3.10.7) 
This may be obtained by writing the position of the mass in terms of the Cartesian 
coordinates x and y, taking the derivative to obtain the respective velocities, and 
then noting that the velocity directed along the r axis is the square root of the sum 
of the squares of the x and y components. As expected, the only variable in Eq. 
(3.10.7) is in terms of the generalized coordinate 8, since this single variable (along 
with the constant radial distance r,,;,) is sufficient to describe the position of the 


point mass. 
The kinetic energy associated with mass Mp 1s: 


Ex = 3M,(r? + 16) (3.10.8) 
As one would expect, Eq. (3.10.8) is a function of the two generalized coordinates, 


rand 0. 
The Lagrangian is given by: 


L = 4M,r2,,62 + 3Mp(? + 176°) (3.10.9) 
The generalized force associated with the @ axis is the torque given by: 
T = Mor2igb + Mp 126 + 2Mgr 07 (3.10.10) 
while the generalized force associated with the r axis is given by: 
F = Mi — Mar & (3.10.11) 


Examination of Eq, (3.10.10) shows that the first two terms are what would 
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be expected from the point mass approximation of inertia. 9 term contr; ut 
to the inertia has a different radial distance from Its corresponding mass to , e Bh 
Of rotation. The last term is the Coriolis force seen by the actuator of t il 
due to combined velocities of both the @ and r axes. Note that the Coriolis fo - 
Will be zero if both axes do not move simultaneously. Based on the esi 
performance of the system, one can get a numerical value for the contributio, 
the Coriolis force which could be conceivably large or small with respec to the 
two other terms. ‘buti 

The first term of Eq. (3.10.11) shows the contribution to the force d 
acceleration of the point mass while the second term Is a centripetal force 
occurs at the joint actuator attached to the r axis due to a velocity at the joint 
controlled by the 6 actuator. This term indicates a force applied In a radial directio, 
directed inward and proportional to the distance r that the axis 1S extended. 

This simple yet illustrative example shows that by using Lagrange’s Equation 
we were able to determine the required torque and force on the joint actuator. 
and account for forces due to the interaction of the motions of the POINnt masses 
At this point, it may be interesting to investigate a generalized expression that 
results from the use of Eq. (3.10.2). For discussion purposes we will assume there 
are two generalized coordinates (q, and q,) and therefore two generalized forces 
(F, and F,). The generalized forces for each of the joint actuators that arise from 
dynamic interactions between the links may be expressed as: 


Which 


Fy = Dig, + Dign + Dyyq3 + Dyx0q3 + D4129192 + Dy2190q, + D, (3.10.12) 


Fy = Dog, + Dyqz + Dyyqt + Dy 9q3 + D3199192 + Dar1929, + D5 (3.10.13) 
Note that there are essentially three types of terms in Egs. (3.10.12) and (3.10.13): 


e Those due to acceleration 


e Those due to the product of velocities 
e Those due to gravity 


The coefficients may be identified as follows. The first Subscript indicates the 
generalized force while the second (and possibly third) indicate where the cause 
of the force is originating. Table 3.10.] defines the coefficients. 


| The effective mass Or inertia is the value of mass or inertia one would compute 
if all the inertial loads were reflected to 


the axis of interest. e apparent 
from Eq. (3.10.10). The coupling inertia or mass states fot lem the 
j ai axis will cause a force to be applied to axis 7. Thus we see that the concept 0 
Inertia Is not as simple as presented in Section 3.3.2. It may be interesting to noté 
[19] that if coupling inertias are sm; " to the eae joint inertias, 
the manipulator may be treated as a Series of independent mechanical systems: 
In this case, the analysis techniques of Section 3 7 may be used to define the 
dynamics of each joint-link pair. Coupling inertia res appear in kinematic 
configurations where two point Masses are Coupled b Pe ch as for 4 
SCARA or a jointed arm), aS a (oe 
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TABLE 3.10.1 COEFFICIENTS OF 
GENERALIZED FORCE EQUATION 





Cocfficient 


Desc ription 


Sa 





D Effective inertia or mass 
Dj; Coupling inertia or mass 
Di, Dj; Centripetal term 

Di, Di Coriolis term 

D,; Gravity term 





The centripetal terms show the contribution to the force at axis / due fo 4 
velocity occurring on either axis orj. The Coriolis terms show the contnbution 
of force due to a combined velocity of the i and j axes. | 

As one can see, the use of Eq. (3.10.2) can result in a nonlinear differential 
equation [see Equations (3.10.10) and (3.10.1 1)]. | The dynamic equations are such 
that the torque Or force for a given actuator is defined explicitly for the movements 
of all the joints. These equations can be used to model the performance of . 
manipulator so that the dynamics are included; however, for the actual _— 
mentation of a commercial robot, it is usually adequate to provide actuators wit , 
sufficient headroom, a control system capable of driving the actuators, and a profile 
generator that supplies the control system with the appropriate signals (such as 
position versus time). The concept of the profile generator and multi-axis control 
is discussed in Chapter 8. _ | 

Thus one objective of using Lagrangian analysis is to get a handle on the 
magnitude of the forces or torques that can be required by each of the _ 
actuators. By knowing the maximum velocities of each joint (either — i 
requirements of an application or a desired performance specification) om : : 
maximum payload that the manipulator can carry (along with ane ite. ss O 
the links and their internal components) one can pertorm a worst-case — i 
obtain the magnitude of a torque or force that a joints aCKUAtOE must upp’? | sore 
permits the proper sizing of an actuator and can also give insight into the dynamic 
trol signal. 
nhac Sihieustaaiea on Lagrange’s equation, the reader pes rere 
[21], or any other theoretical mechanics textbook. For a more pron ff = 
of the Lagrangian to robotic manipulators, [20] pS — 
while [19] presents a method coupling the Lagrangian eee on . 
concepts of homogeneous transforms (which are presented 1 ap , 


3.11 SUMIMARY 


of some of the considerations required for the 


robots from a mechanical systems point of view. 
of linear systems were considered with respect 


This chapter provided an overview 
successful design or applications of 
Topics in dynamics and modeling 
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Chap. 
to obtaining the motions required by revolute and prismatic axes of a mani 

In addition, some of the limitations and properties of real-world COmpone Pullatoy 
discussed to make the reader more aware of the practical problems that Oday, Were 
robots are applied. Finally, a brief introduction to the modeling of the When 
dynamics of a manipulator was presented. Based on this discussion, the ental 
Should be aware of the complexity of the dynamics of a manipulator but Pia 
also understand that detailed analysis of this type can be used to Predict wend 
case situations, and excruciating analysis may not be necessary to design a a 
manipulator. ne 


3.12 PROBLEMS 


3.1 Compute the torque required to balance a 5-lb load mounted to the end of a bar 
to Figure 3.2.6 as a function of the angle that the bar makes with the hor 
Assume that the length of the bar ranges from a minimum of 36 in. to a max; 
72 in. For the minimum and maximum lengths, plot the torque as a function 
What is the average value? What is the rms value? 


3.2 A rotational system consists of an inertial load J, a viscous friction coefficient Bia 
Static friction component F,, and a Coulomb friction component F,. It is desired to 
accelerate the system at a constant angular acceleration of 1 rad/s per second for t, 
seconds and then run at a constant velocity of 1 rad/s. Sketch the angular acceleration 


and velocity as a function of time; also determine the torque that must be supplied as 
a function of time. 


Similar 
ZOntal. 
mum of 
of angle. 


3.3 The inertia of a disk-shaped component of radius 7, height h, and weight w is given 
as J,. Suppose that it is desired to reduce the original inertia by a factor of 0.5. What 
is the new radius and weight with h fixed? What is the new height and weight with 
r fixed? 

3.4 For the case of a sphere (see Figure 3.2.9) find the error between the exact computation 
of inertia and the point-mass approximation as a function of r and R, where r is the 
distance from the sphere’s centroidal z axis to another axis parallel to it and R is the 
radius of the sphere. In other words, how far from the axis of rotation does the sphere 


have to be before the point-mass approximation yields an acceptable error of 1%? Of 
10%? 


3.5 a. For the gripper of Example 3.2.3, compute the inertias about the z and y axes if 
payload of 5 |b (weight) is inserted inside the gripper. Assume that this mass 
completely fills the gripper when inserted. 

b. Repeat part (a) if the same payload exists but extends 1 in. outside the grippe! ” 
all dimensions. 

3.6 a. Derive the equation for the total inertia about a pivot point due to a payload : 
weight W located a distance r from the pivot and a counterbalance of weig" 
located a distance r’ from the pivot (refer to Figure 3.2.6). tef- 

b. What relationships between r and r’ must exist for the inertia due to the COU” 
balance to be negligible? 


J . e e nce 
c. What happens to this relationship if the inertia of the payload and counterbala 
cannot be approximated by Mr2? 
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Comment on how a spring could be used t 
Write the equations for a configuration similar to Figure 3.2.6 
Assume that a simple manipulator consists of a prismati aes | 
such that when fully retracted the tip of the robot ie se - — ear on y - 
re ~ : i . ; , m : 
fully cara ae UP 1S 60 in. from the pivot. The prismatic islet is pivcted oe 
pendicu ar to the aes It will be assumed that the joints and an ¢ : : p 
weightless and inertialess by themselves; however the pa iks of the robot are 
imum of 5 Ib to 25 Ib. Payload will vary from a min- 
a, Compute the torques necessary to statical| | 
. : ally balance the joint f i 
cases (5 Ib retracted, 5 Ib extended, 25 Ib retracted, 25 b exte 1d e =" 
b. Compute the inertias for all four cases. ance 


c. Design a nakernpe-peraeey So that the “optimal” torque rating is obtained for all four 
—_ in vhs ae — torque and minimum inertia. Comment on the 
relationship between the distance of the counterwe; i 

eigh é 
an the inertia, ght from the pivot and its effect 

d. Compare raphon peak torques for the four cases with and without the counter- 
balance if the joint is moved from a horizontal position to perpendicular with respect 
to the ground. | The motion is described by a trapezoidal velocity profile having 
equal acceleration, deceleration, and constant-velocity periods. 

a. Usinga cable and a disk of known inertia, find the spring rate of the cable by means 
of a torsional pendulum. 

b. Check the validity of the cable’s spring rate by using Eq. (3.2.32) and your spring 


rate to determine the inertia of another object, such as a slender rod whose inertia 
you can calculate. 


oO 
counterbalance a robotic manipulator. 


Make a wooden model of a more complex metal structure. Use a physical pendulum 
to determine the inertia of the wooden model. Determine the inertia of the actual 
part by modifying the value of inertia you measured by a ratio of the densities of both 
materials. 

Derive Eq. (3.2.35). 


Compute the work done by a torque that is used to accelerate a weight of 5 lb connected 
to a rod of 30 in. through a distance of 90° with a terminal velocity of 90° per second. 
What is the power? 


For a gear train similar to Figure 3.3.1, assume that N,/N, = 100. If an input torque 
of 5 oz-in. is applied to shaft 2 with a speed of 10 rpm, what is the output torque and 
speed? Repeat the problem if N,/N, = 100. 


Employing the same concepts that were used to develop Eq. (3.3.4), the transfer 
relationships between the input and output shafts of a compound gear train (i.e., one 
consisting of more than two gears) may be derived. 

a. Derive the transfer relationship between the input and output shafts of a gear train 
consisting of three gears. The input gear has N, teeth, the middle or idler gear 
has N, teeth, while the output gear has N, teeth. 

b. Assume that a system consists of two gear trains, each similar to the one shown in 
Figure 3.3.1. The output of the first gear train 1s coupled by a rigid shaft to the 
input of the second gear train so that both gears are affixed to the same shaft. The 
number of teeth of the first gear train from input to output is N,/N,. For the 
second gear train the input gear has N, teeth while the output has N,; teeth. Com- 
pare the overall transfer relationship to the three-gear system of part a. 
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For the system shown in Figure 3.3.3, assume that the inertia of the 8 m 
be included. The inertia of the gear oe the en her a J,,, while that of ie. Als 
on the output shaft isJ,,. Derive a series of equations similar to Eggs. (3.3.8) - Bea, 
(3.3.8c) which include these terms. . . Ugh 
For the belt-and-pulley system of Figure 3.3.7, derive an expression Similar is 
(3.3.4). 
Derive an equation for the total inertia as seen by the input for the System ~— 
Figure 3.3.11. Include the inertia of the pulleys. What happens if the Tadii of ‘ 
two pulleys are not equal? . h 
Derive the relationship for the input shaft position and the linear Stage’s Position 
the slider crank of Figure 3.3.13. Find an expression that defines the torque 9-",°! 
input needed to accelerate the mass on the linear stage from any initial POSition tp i. 
final position over a single-valued motion. Y 


Comment on the design of a simple pick-and-place mechanism using cams, Define 

simple motion such as rising above a point 1 in., traveling forward 2 In., and then 

descending 1/3 in. Draw the cam profiles and suggest a simple mechanism for accom. 

plishing this task. 

a. For the mechanism shown in Figure 3.3.21, derive the relationship between the 
length of link 1 and the angle of link 2 with the vertical. 

b. If a 5-lb point mass is hung at the end of link 2, what force must be exerted by link 
1 so that the system is statically balanced? 

c. Assume that link 1 is implemented by a lead screw and nut having a pitch of 5 
turns/in. What torque must be exerted to statically balance the mechanism? 

d. Compare this mechanism to that of an implementation as designed in Figure 3.2.6, 
What are the advantages and disadvantages of each in terms of such quantities as 
range of motion, required torque for static balance, and so on? 


a. Derive the optimum coupling ratio with respect to minimum power dissipation in 
a de motor for the case of a de motor with an inertia J, driving an inertial load J,. 
a viscous load B,, and a constant torque load T, through a gear train. 

b. What happens if the inertia of the gears is not neglected? 


c. Do a sensitivity study based on changes in the coupling ratio and the loads J;, B:. 
and T,. 


a. Consider a 2-axis cylindrical coordinate robot with an r-axis whose extension range 
falls within 25 to 45 in. Assume that the r-axis rotates parallel to the floor so thal 
the effect of gravity may be neglected. Let J . be the inertia seen by the rotaly 
joint which is a function of r, 

b. Using the same model as shown in Figure 3.5.11, compute the locked rotor and 
free rotor resonance frequencies. Examine the results if J, is equal to the minim” 

value of J, , J, is much smaller than the minimum value of J, and J, is much grea’ 


a ed 
than the minimum value of J,.. Comment on how a gear ratio should be select 
based on the foregoing results. 3.1 

Draw analog circuits for the mechanical networks in Sections 3.5.2, 3.5.3, and 3..°: 


of the torsional roc the 
Mode] the torsional resonance phenomenon with an electronic circuit and explor® 
relationship between J Ji, K, and B 


a? 

a. Derive an equation similar to Eq. (3.8.1 
b. Draw a set of curves that define ; a 
ain ne accuracy over the entire workspace as 

of r, 0, and z. y nure P 


. are 3180 
) for the r-6-z workspace for Pie euntio 


Sec. 3.12 Problems 
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, 26 Include the effects of mechanical inaccuracies in Peg. (3.8.1) 

327 Compute the inertia of the gripper in Example 3.3.3 by 
_ solid, and subtracting the inertia of elementary shape: 
looks like the gripper. 


assuming that the gripper ts 
apes so that the remaining figure 


3,28 For the Lagrangian analysis of the @-; manipul 
Equations (3.10.10) and (3.10.1 1), assume 
of each axis so that the acceleration, const 
same. Investigate the relationship be 
and r actuator so that: 

a. Coriolis force 1s minimized. 
b. Coriolis force 1s maximized. 
ec. Centripetal force is minimized. 
d. Centripetal force is maximized. 


3.29 Extend the analysis of Figure 3.10.2 given by Eqs. (3.10.10) and (3.10.11) to include 
a third degree of freedom, i.e., in the z direction. Comment on each of the terms tn 
the force equation for z. Do Eqs. (3.10.10) and (3.10.11) change? 


3.30 Assume that Figure 3.10.2 is in the y-z plane. Perform the Lagrangian analysis taking 
into account the potential energy of both point masses. 


3.31 a. For each of the kinematic configurations shown in Figure 3.6.3 sketch the incre- 
mental workspace (similar to Figure 3.8.8). 
b. Derive an expression for the accuracy of a point defined in Cartesian coordinates 
as a function of the joint variables. 
3.32 For the slider crank mechanism shown in Figure 3.3.13 


a. Derive an equation for the position of the reference point of the payload as a 
function of the crank angle, 0. 

b. Sketch the position of the payload as a function of time if the crank is rotated at a 
constant velocity (i.e., do not include effects of acceleration and deceleration). 

c. For a trapezoidal velocity profile applied to the crank for a total crank displacement 
of 180° (so that the reference point moves from one extreme to the other) and equal 
times for acceleration, constant velocity, and deceleration: 

Sketch 

1. position versus time, 

2. velocity versus time, 

3. acceleration versus time, and 

4. jerk versus time 

for both the crank angle 0 and the position of the reference point. 

d. Compare the frequency content of the corresponding signals for the crank angle 
and reference point position. That is, examine the frequency content of the trap- 
ezoidal profile defining the velocity of the crank and the protile defining the velocity 
of the reference point. 

3.33 Assume that the r — 6 manipulator shown in Fig. 3.10.2 and described by Eqs. (3.10.10) 
and (3.10.11) has the following parameters: 
= 2.0 in. 


ator given in Section 3.10. specifically 
a trapezoidal velocity profile for the motion 
ant velocity. and deceleration times are the 
{ween the maximum velocities of the @ actuator 


Finin 
M, = 1.0 lb weight 
M, = 1.0 Ib weight. 


a. If the tip of the manipulator is moved from the x,y coordinates (0, 10) to (10, 0) 
in a straight line (as described in Section 8.8.2 and Figs. 8.8.1, 8.8.2, and 8.8.3) 
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a) 
plot the contributions to the total torque and — . well as the tota ~ 
force curves. Use 33.3 ms for the acceleration, deceleration, and constan, Yue ang 


time of the velocity profile. a City 
b. Repeat part a if joint interpolated motion Is used instead of Straight-lin | 
c. Compare the force and torque requirements for straight-line Versus joint imo 
lated motion. ‘erpo. 


d. Repeat parts a, b, and c for a motion from (0, 10) to (5, 0). 


3.34 For the manipulator shown in Fig. P.3.34 


y 


Joint 1 ——————_» 





b. Repeat if the effects of gravity must be considered. 
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Control of Actuators in Robotic 


Mechanisms 


4.0 OBJECTIVES 


In this chapter we present the practical aspects of controls as they relate to robots, 
with the emphasis being placed on how robotic actuators are driven to achieve a 
desired performance. It will be assumed that the reader has a basic knowledge 
of “‘classical’” control theory, and hence topics such as Laplace transforms and 
stability theory will not be developed. However, these and other concepts will be 
used in discussing typical and reasonable control models that are applicable to 
robot systems. The material will be presented from the standpoint of a servo- 
mechanism rather than from the more traditional theory of controls approach. 


Specifically, the topics that will be covered are as follows: 


Closed-loop position servo 


e Frequency response of a typical joint position servo 


e Frequency-domain compensation techniques applied to this servo to ™ 
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eel 
joint specifications 

Effects of gravity and friction on robot performance 

Role of position and velocity feedback 

Elimination of position error 

Robotic actuators including de servomotors (brush and brushless type 


per motors, direct-drive motors, linear motors, and hydraulic and pre 
devices 


), step 
ymati¢ 


Sec. 4.1 Motivation 


e Power amplifier configurations | 303 
mevecs » !MCluding line 

e Differences between volt 
operation of a servo 


ar ; : 
and Pulse-width-modulation 


Ake and 
CUrrent amare: 
Nt amplifiers nd their effects on th 
e 
Also included is a brier discussio 
“CUSSION o 


how these more modern disciplines f both 


(h Optimal . 
Might be Ptimal and 


1 adaptive ; 
Utilized to control ene Control and 


Ola robotic actuator. 


41 MOTIVATION 


One of the major objectives of 
may not be carrying qa special-p 
accurate and repeatable Manner, we 
unreasonable to assume that the indiv; inte so |S imp Prtant, so that it is not 
Since this is true in most of the r , 
details of the position servo. 
disadvantages of the pure digi 
both analog and digital Components) servo. 
A typical robot has a master computer that is responsible for sending th 
appropriate position commands (often referred to as “set points’’) to sakan he 
joints (axes). This information is used by a separate computer (or mishtaieneeneac 


Joint 
Joint Power Joint Joint Beis Position 
Processor #1 Amplifier Actuator Mechanism Sensors 
Set Point 
Information 
Joint Power Joint 
Processor #2 Amplifier Actuator 


O 
O 


O 
\ Joint Power 
Processor #N Amplifier 


Migure 4.1.1. Common robot control architecture. 
sensors are actually mounted at the actuator output. 


Joint 


Joint Joint Position 
Mechanism 





Master 
Processor | 









Joint 
Position 





Joint Joint Joint 
Actuator Mechanism Sensors 





It will be seen later that usually, the 
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P.4 
ed to provide some or all of the following funcs; 
oints and actual position so as to obtain apie 
error, (2) interpolation of the master’s sct points, and (3) digital filtering (or 
pensation) of the joint. In any event, this processor produces the require a 
mands to the axis actuator [e.g., either servo OF other types of motors or hydray}, 
(or pneumatic) devices], which will then cause the particular Joint to move. i‘ 
formation about whether and/or how it Is actually moving may Or may not be oe 
In the latter instance, the axis is said to be operating In an open-loop manne, 
whereas in the former case, the term closed-loop applies. The major emphasis it 
this chapter is on closed-loop control (of a robotic joint) because the Overwhelming 
majority of the robots currently available utilize such a control structure, Only 
those simple robotic devices driven by stepper motors or simple pneumatic or 
hydraulic actuators may actually utilize open-loop control. 

It is important to understand that the term “closed-loop”’ as applied to robots 
does not mean that the loop is closed back to the master computer (see Figure 
4.1.1). Inreality, current control practice requires that information about the axis 
motion be fed back only to the corresponding joint processor. The master is 
informed only when the move is completed or if an emergency situation arises 
(e.g., the manipulator encounters an unexpected obstacle). It is to be expected, 
however, that as more powerful microprocessors become available at reduced cost, 
this situation will certainly change. 

In general and with relatively few exceptions, the loads that must be moved 
by a typical robotic joint actuator vary considerably as the manipulator moves 
throughout its workspace. Most certainly, such variations should be taken into 
account when trying to determine the proper control action. The fields of adaptive 
and/or optimal control would be appropriate in this context, and it is for this reason 
that these topics are discussed (although briefly) later in the chapter. Howevé! 
current robot design practice usually ignores such variations and utilizes a worst 
case (load) approach. Consequently, the discussions contained in the succeeding 
sections of this chapter will assume that the load is constant. As the reader W! 
come to appreciate shortly, the results of this admittedly gross approximation are 
surprisingly good (but obviously not optimum from the point of view of motion 
speed and power required). It is reasonable to expect, however, that more modern 
control techniques will become feasible with the advent of lower-cost and mor 
powerful microprocessors. 


Often, the joint processor is us 
(1) digital summation of the set p 


4.2 CLOSED-LOOP CONTROL IN A POSITION SERVO 
The block diagram of a typical closed-loop control system is shown in Figure = 
Here some desired function or (position) command is the input and the resp? an 
(or actual position) of the system or joint is the output. A contro 
amplifier are used to drive a motor which then drives a load (e-8-> ! ices 
Knowledge of how the joint is moving is provided by one or more sensi dev 


an 
jler at 
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Sec. Az 
Input Controller Output 
ired response) and | onse) 
(des! Amplifier (actual resp 







Sensing 
Device 


Figure 4.2.1. General closed-loop control system. 


e.g., an optical encoder or tachometer; see Section 4.5) and this information is 
used to produce an error signal, which, in turn, drives the controller/amplifier, and 
so on. For reasons that will become apparent shortly, a typical position servo will 
ually use two sensing signals: position and velocity. 

Let us now consider the specifics of the pure analog position servo shown in 
Figure 4.2.2. In this diagram, 0, and 6 are the desired and actual joint positions 
with w(t) (= 9) being the angular velocity of the joint. Also, K, and K, are 
position and velocity gains, with A and K,, the amplifier and motor gains, respec- 
tively. Here a single-pole model for both the power amplifier and the dc servo- 
motor is assumed (a more complete model for the latter device is developed in 
Section 4.3.1). Since angular position @ is related to the integral of the angular 
velocity w(t), an integrator is shown in the diagram. The reader should understand 
that this is for modeling purposes only since in practice, @ is actually obtained 
through the use of a sensor (e.g., an optical encoder), as will be discussed in Section 


4.5. 


2) 


act 


Integrator 


+ ' 


| 
| Amplifier Motor 
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Velocity Sensor 


Velocity Loop 
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Position Sensor 


Figure 4.2.2. Typical analog position servo showing the velocity and position 
loops. The latter consists of the velocity loop, position sensor, integrator, and 
summing junction 2. 
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With respect to Figure 4.2.2, it is interesting to note that since an ular 
is fed back to summing junction 2, the position error can be viewed a8 a “Oc, 
command signal to the block marked “‘velocity loop. In fact, it is not ung it 
to specify the shape of the velocity versus time curve (i.e., the velocity : Mon 
The command position signal is then adjusted so as to produce this prac 
drive the joint to the desired final position. © and 


4.2.1 No Velocity Feedback 


First consider the case where there is no “tach” or velocity feedback: that js th 
velocity sensor (e.g., a tachometer) is removed so that K, = 0 and hence the 
velocity loop in Figure 4.2.2 is open. Then the overall open-loop transfer functio, 
for the system in this figure becomes 


AK,K,, 
af ahea\? © oof (4.2.1) 
s(1 + s7,4) (1 + 5 ty) 
Typical values for the reciprocals of the motor and amplifier time constants 7,, and 


T4 are 10 to 20 rad/s and 6000 to 60,000 rad/s, respectively. Defining the Open- 
loop gain constant to be 


GH (s) = 


K = AK,K,, (4.2.2) 


the root locus of this system is shown in Figure 4.2.3. 


—— 











(7, + Tr) 
Ts- 
3TaTy 
1 
= 3T ATM [tat ru TA TAT + Th | 
1 1 
ero on 


Figure 4.2.3. Root locus for the system described in Eq. (4.2.1). 
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Figure 4.2.4. Typical damped sinus- 
oidal response to a position step com- 
mand. 


Using standard root-locus techniques, it is found that the system will become 
unstable if K > K 


cross (= I/t4 + I/ry), that is, the poles of the closed-loop system 
will move into the right-half portion of the s-plane and the response of the system 


will increase without bound (‘“‘blow up”). Also, for K less than Kos; and greater 
than K, (the gain where branches of the root locus leave the real axis), the poles 
of the closed-loop transfer function are complex conjugates (with negative real 
parts), so that the system exhibits underdamped performance. That is, a step 
command in @, will cause @ to respond as shown in Figure 4.2.4. Usually, this 
type of behavior is undesirable, as it will not produce the fastest moves for a robot 
joint. That is, the final steady-state position will not be reached in the shortest 
time. Also, significant stresses on the mechanical components may be produced 
due to the rapid acceleration and deceleration required, as this final position is 
overshot (or undershot) and the servo is forced to make several corrections to 
bring the joint back to the desired point. To reduce or eliminate such response, 
it is necessary to provide the axis (joint) with some type of damping in order to 
reduce or eliminate the oscillations entirely. A certain amount of damping is 
inherent in the components themselves (e.g., motor and gear frictions) and in some 
instances may be sufficient to produce an acceptable response characteristic (1.€., 
either critically damped or just slightly underdamped). When this is not the case, 
however, another source of damping must be employed. This usually takes the 
form of viscous friction [i.e., a friction torque that is proportional to angular velocity 
o(t)] and is obtained from “‘tach” or velocity feedback. 


4.2.2 Position Servo with Tach Feedback 


Now let us restore the tach feedback in Figure 4.2.2, that is, consider the case 
where K, is not zero. It will be demonstrated shortly that doing this will produce 
the desired damping in the position loop. Using standard block diagram simplifi- 
cation techniques, the open-loop transfer function for the joint with tach and 
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position feedback ts found to be 
AK,,(K, + sK,) 


GH(s) = s(1 +- sty) + St,) (4.2.3) 


a zero to be added to the overall] OPpen-|o 
Using Eq. (4.2.2), the root locus fo, the 


system (plotted as a function of K) is shown in Figure 4.2.5. It is observeg that 
in both cases, the system is now stable for all (positive) values of K. Inthe second 
case shown in Figure 4.2.5b, however, there is a dominant set of poles. Physically 
this means that the pole due to the amplifier has little effect on the closed-loop 
response of the system. Under these conditions, the Joint-position servo can be 
approximated by a second-order system, and the closed-loop transfer function 


Note that velocity feedback causes 
transfer function (at s = —K,/K,). 





becomes 
T(s) = O(s) _ AK,, 
0s) s?ty + s(1 + AK,K,,) + AK,,K, 
or 
T(s) = AK,,/T™u 
s* + s(1 + AK,K,,)/ty + AK,,K,/t™ (4.2.4) 


It can be shown that for a second-order system, a general form of the closed- 
loop transfer function is given by 
2 


Ww 
= +35 4.2.5 
Is) s* + 26w,5 + w2 ( ) 


where w, is the undamped natural radian frequency and ¢ is the damping coeffi- 


cient.* Comparing Eqs. (4.2.4) and (4.2.5), the damping coefficient for the joint 
with position and tach feedback 1s then found to be 


_ 05(_+ AK, Ky) 426 
VAK,, K, ty 


Several important conclusions can be drawn from this equation: 


J. The more tach feedback (i.e., as K, is increased), the more damping pt 
wil] be in the position servo. Thus the joint response will tend to becom 
less underdamped as K, is increased, and vice versa. te 

2. The more position feedback (i.e., as K, is increased), the less damping a 
will be. Thus the joint response will tend to become more underdamP é 
K, is increased, and vice versa. 


gampe? 





* The system transient response as a function of Cis underdamped for 0 < ¢< 1, critically 
for ¢ = 1, and overdamped for ¢ > J, 
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Figure 4.2.5. Root locus for a position 
servo with velocity feedback: (a) K,/K, 
< I/ty; (b) K,/K, > lty. 





Thus it is seen that tach feedback has the effect of making the individual joint 
Servo more stable and less oscillatory. It would also appear from the above that 
using the smallest value of K, would keep the system from being underdamped. 
Although this is true, it will now be shown that other considerations limit the 
minimum value of position feedback gain. 
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4.3 THE EFFECT OF FRICTION AND GRAVITY 


one of the major goals of a robot is to move 
n an accurate and repeatable manne; at 


achieved is clearly undesirable anq Mus A 
eliminated. In practically all electromect there 


As mentioned previously, , 
a part from one point to another 1 
that prevents this goal from being 


fore, either be compensated for or ian 
pneumatic—mechanical, or hydraulic- mechanical systems, friction in Various ical. 


ponents will create a position error. Also, gravity will produce a POsition ‘Ning 
of varying magnitude in one or more joints for most robots. To see more clenn 
the effects of these “disturbances,” it will be necessary first to conside; mk, 


complete model of a dc servomotor. 


4.3.1 Modeling the DC Servomotor 


One of the common methods of driving a robotic joint is through the use of ad 
servomotor, a fractional-horsepower motor with a stationary magnetic field that is 
generated by a permanent magnet. [For this reason it 1s sometimes calleq A 
permanent-magnet (PM) motor.] No power is used in the stator structure of this 
device and the field is constant over a wide range of armature currents. A py 
motor usually requires less cooling than do other types of de motors (e.g., a shunt 
motor). Other advantages of the PM motor over the wound types are: 


1. Highstall torque. This is an important characteristic during joint acceleration 
and also when the manipulator is required to keep a load stationary. 

2. Smaller frame size and lighter weight for a given output power. This is 
especially important in a robot, where the design may require the motor to 
be moved within the joint itself. 

3. The speed—torque curve of a PM motor is linear, as shown in Figure 4.3.1. 
If these curves were nonlinear, a potentially significant amount of extra com- 
putational effort might be required of the joint processor to ensure that a 
given amount of torque (or current) was produced by the motor. 


A linear circuit model of a dc servomotor armature is shown in Figure 4.3.2 
Here R, is the total armature resistance (including that due to the brushes), Kz ® 
a resistance that represents the magnetic losses in the armature (and is normally 
>> R, since these losses are usually small at the frequencies of interest), L,%s ne 
armature inductance, and E, is the back EMF produced when the armature gt 
in a dc magnetic field. ‘This last term is proportional to the angular velocity ” 
of the armature (i.e., 6). That is, 

4.3.1) 
E, = 0()\Ke ( 


where K,, is referred to as the back EMF constant of the motor. Applying ele 
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Figure 4.3.1. Speed and current versus 
Torque (0z-in.) torque for a DC servomotor. 


mentary circuit theory to Figure 4.3.2 and using Eq. (4.3.1) gives 
Varm = Rl, + Lal, + o(t)Ke (4.3.2) 


I, and J, represent the armature current and its time derivative. 


As shown in Eq. (4.3.1) and Fig. (4.3.1) the torque generated by the armature 
moving in a PM field is linearly related to the current. Thus 


T, = Kyl, (4.3.3) 


where K; is the torque constant. This generated torque is required to accelerate 
an inertia (usually consisting of the motor armature itself and an external load), 
overcome any viscous damping torque due to the motion of the armature, and to 


Ls 


Figure 4.3.2. Circuit model of a DC 
servomotor armature. 
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: “4 
overcome any external load torque (e.g., due to either gravity or static. ftice 
Thus we may write “Hon) 
T, = (Iu + Jn) a(t) + Bolt) + Ty + Te 43 
4 


In this equation, Jy and J; are the armature and reflected load iNertias (wh; 
convenience will be combined and written as Jp = Jy + J;), Big the a 
viscous damping coefficient, T; is the friction torque of the motor anq the Ure 
(including the gears, etc.), and T,, is the gravitational torque load. is oad 
assumes that all components of the rotary system turn in phase (i.e., thes 
torsional resonance in the system; this topic 1s discussed in Section 3.5.3.1), nha 
that if the load has any viscous friction, this can be added to B. me 
Combining Eqs. (4.3.1) through (4.3.4), the model of a servomotor (includ; 
the friction and gravity terms) is found to be the one shown in Figure 4.3.3, Usin 
block diagram reduction techniques, the transfer function of the motor becomes 
15) 
Om’) = 70) 
- K,/L,J 7 
s° + [(R,Jp + LBL Jrls + (KrKe + R,BYL,Jy 


It is important to note that the disturbance torques T; and T,, do not appear in 
this expression because they are treated as additional inputs. They will be utilized, 
however, later in this section. 

In developing the results above, it has been assumed that the load inertia 
(reflected back to the motor shaft) does not vary with time, so that J; is a constant. 
This nontrivial assumption is valid for a large number of applications. Unfortu- 
nately, however, the actuation of a robotic joint is usually not one of them. In 
fact, the reflected inertia of most of the axes of a robot will normally fluctuate 
significantly while the manipulator is moving. An example of such behavior can 
be seen in Figure 4.3.4, where the inertia variation for each of the six joints of a 
JPL-Stanford arm is shown. It is observed that the inertia of joint 1 (i.¢-, the 


(4.3.5) 


Tis) + T,,(s) 


= | gis! 
Vern($) + 1 |,(S) , T,(s) + 1 
R, + sL, ' Bt sJr 


7 a det urbe 
Figure 4.3.3, Block diagram of DC servomotor including gravitational and friction dst 
ance torques. 
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RELATIVE MAXIMUM VARIATIONS IN TOTAL LINK INERTIAS ARE 
REFERRED TO THE CORRESPONDING JOINT OUTPUT AND 
NORMALIZED TO THE MINIMUM TOTAL INERTIA VALUE AT qn 

8 CORRESPONDING JOINT, ASSUMED LOAD; 1,8 kg, 442 cm~(4 Ib, 27 in?) 
CUBE SYMMETRICALLY HELO IN THE HAND. 
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Figure 4.3.4. Inertia variations for each of the six joints of a JPL-Stanford arm. 
Both variations with and without a load (carried by the gripper) are shown. (Cour- 
tesy of A.K. Bejczy and Jet Propulsion Laboratories, Pasadena, CA.) 


“trunk’’) varies approximately 4.5 times under no load conditions and by as much 
as 7 times when the manipulator is carrying a 4-1b load. Joints 2, 4, and 5 are 
seen to have significant variations also. Only axes 3 and 6 have relatively constant 
inertias over their entire range of travel. This behavior is typical of other robots, 
although the specific inertia fluctuations may be different. Despite the fact that 
the inertia of a robotic joint usually does undergo dramatic changes as a function 
of the manipulator position, it is common design and control practice to ignore 
this and to assume that J, isaconstant. The resultant computational simplification 
permits a ‘‘worst-case” approach to be used whereby the motor and associated 
mechanical linkages and gears are selected for the maximum load (i.€., inertia) 
conditions. It is apparent that this may not produce the lowest-cost design. Al- 
ternatively, the system is ‘“derated” under full load so that maximum acceleration 
is not permitted under this condition. Hence, smaller, less costly components may 
be used. 

Regardless of which of these design processes is selected, the control of the 
individual joints of a robot is usually accomplished by assuming that there is no 
lime variation of the load inertia. Compromises in performance are the inevitable 
consequence (e.g., reduced speed and/or payload capability of the manipulator). 
It is reasonable to expect, however, that as microprocessors become more powerful 
and cost-effective, adaptive schemes that compensate for the large changes in 
reflected inertia will be used. A corresponding improvement in performance will 


undoubtedly result. This is discussed briefly in Section 4.5.5. 
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EXAMPLE 4.3.1 ™ 


Let us find the poles [i.e., the roots of the denominator polynomia] 0 
of a commercially available dc servomotor. For example, the Para 


m(s)| 
Meter 
an Electrocraft Corporation E530 motor are: 


S of 


Ky, = 10.02 oz-in./A 
K,, = 7.41 V/1000 rpm 

, = 1.64 2 (including brush resistance) 
L, = 3.39 mH 

B = 0.1 oz-in./1000 rpm 


Ju = 9.0038 oz-in.-s? 

Assuming that there is no inertial load coupled to the motor shaft, J, = J 
in Eq. (4.3.5). Since the gravity and friction terms do not affect the motor 
poles, we may also assume that T; and T,, are both zero, so that Eq. (4.3.5) 
is applicable. To utilize this equation, K,; and B first must be converted to 
V/rad/s and oz-in./rad/s, respectively, in order to have a consistent set of 
units. This is accomplished by dividing each of the given parameters by 
104.72. Thus 


Ky = 0.0708 V/rad/s 
B = 9.55 xX 10~* oz-in./rad/s 


These parameters can now be substituted into Eq. (4.3.5). The actual transfer 
function for the Electrocraft motor is found to be 


7.778 X 10° 
s* + 484.027s + 5.516 x 104 


As mentioned above, the roots of the denominator polynomial will give the 
motor poles. Thus 


G,,(8) = 


Sy — 183.621 rad/s 


y) — 300.406 rad/s 


both of which are observed to be negative and real. This is quite ofte 
case for commercial servomotors, implying that the open-loop respon 


er 
such motors (to a step voltage on the armature) will be, in general, 0” 
damped. 


eee 


: ne 
The model of the motor used in Figure 4.2.2 can now be replaced by the pe 
just developed in Figure 4.3.3. This is shown in Figure 4.3.5. Using stan 


n the 
se 0 
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T,(s) + T o(8) 





Figure 4.3.5. More complete model for a position servo. 


block diagram reduction techniques, the actual joint position transform @(s) in 
terms of the command input transform 0,(s) and the friction and gravity terms is 
found to be 


0s) = eqn} 88) — [T(s) + Tes) Mota + 1)(Ra + al} (4.3.6) 


AK; 
where 
- AKr 
(S)equiv = s(st, + 1)[KeKr + (sJp + B)(R, + sL,)] + AKr(sK, + K,) 


(4.3.7) 


Here, T;(s) and T,,(s) are the Laplace transforms of the friction and gravity torque 
disturbances on the joint, and Jy = J, + Jy, as before. 

Using these results, we are now able to investigate the effects of friction and 
gravity on position error that can be expected to occur for a typical robot joint. 
Two cases can be considered. 


4.3.2 Final Position with no Friction or Gravity Disturbance 


Let the command position be a step of amplitude 6, and suppose that there is no 
friction or gravity torque. Then 0,(s) = 0,/s. Substituting this into Eqs. (4.3.6) 


216 Control of Actuators in Robotic Mechanism. 
. Rig 
and (4.3.7), the final value theorem can be used to find the Steady-state . 


the position, 6,,,.;. Thus Alue Of 
Genal = lim 584(5)G(S equiv 
s—>0) 
or 
,  _ AKr . _ 9 
final ~ AK;,K, d K, (4.3) 
This result indicates that the actual joint position will be the desired Position divig 4 
e 


by the position gain. Scaling (i.e., multiplying) the command POsition Signal b 
will permit the actual joint position to reach 6, with no error. Alternative, “; 
different control structure can be used which permits the position loop to be hae, d 
with unity feedback. [For example, K, can be placed in the forward loop, ie 
in cascade with the power amplifier (see Problem 4.7).] This scheme will result ‘ 
zero final position error without the need for the scaling. 


4.3.3 Final Position with Nonzero Friction and/or Gravity Disturbance 


Assume that the joint is commanded to remain in the same position so that 6, is 
constant (for simplicity, assume it to be zero) and that friction and/or gravity 
produces a disturbance to the system. Also define 


Ty(s) = TAs) + T,,(s) 


Furthermore, let this disturbance torque be a step of amplitude 7, so that T,(s) 
= I,/s. Using Eqs. (4.3.6) and (4.3.7) [with 6,(s) = O] and again applying the 
final value theorem, we find that 


TR, 
Orinal — 
AK;K, 


This result indicates that the friction and/or gravity disturbance will cause the steady- 
state joint position to be in error (recall that the desired position was zero). a 
error 1s sometimes referred to as hysteresis. If itis assumed that the power ampli 
has a fixed gain A, it is observed that the right-hand side of Eq. (4-3-9) itn 
made as small as desired by Increasing the position gain K,. Often, the maxim 
hysteresis for a joint is specified (e.g., as O...). If this is so, then 


(4.3.9) 





AK;K, _ max 
and 
~ RT, (4.3.10) 


"  AK.§ 


max 
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PID 
Controller 


T(s) + T,,(s) 






Integrator 


ees 


64(s) 


Figure 4.3.6. Position servo with a PID controller. 


The minimum value of position gain that will keep the position error due to a 
torque disturbance below a certain value is seen to be 


R,T, 
Pun = AKO. (4.3.11) 


If the specified value of the hysteresis is small, the value of K, will be large. 
In fact, this value may be so large that the joint response will either be unstable 
or highly underdamped (recall the discussion in Sections 4.2.1 and 4.2.2). Under 
these circumstances, it will be necessary to use a good deal of tach feedback in 
order to improve the performance of the joint. In a later section of this chapter 
it will be seen that this is not always possible to do. Thus some compromise in 
response may be necessary. _ 

There is another way to reduce or eliminate the position error, however. 
This is accomplished by adding an integrator to the control structure. Such a 
Scheme is referred to as PID (standing for proportional, integral, derivative) con- 
trol. A position servo utilizing such a controller is shown in Figure 4.3.6. In this 
figure the block marked ‘velocity loop” will usually consist of the amplifier and 
*etvomotor. In order to see how the addition of the integral term affects the final 
Value of the joint position, we consider the following example. 


EXAMPLE 4.3.2 


To simplify the transient response calculations, let us assume that the in- 
ductance and viscous damping of the servomotor are zero and that the am- 
plifier pole can be neglected (because it occurs at such a high frequency). 
Then the position servo of Figure 4.3.6 becomes that shown in Figure 4.3.7. 


218 Control of Actuators in Robotic Mechanism, 


hap, 4 





Figure 4.3.7. Position servo for Example 4.3.2. 


Here summing junctions 2, 3, and 4 are assumed to be unity-voltage-gain 
devices (e.g., noninverting op amps). Consequently, the tachometer constant 
Ktacn has the units of volts/rad/s. The specific parameters of the velocity loop 


are 
A = 10.0 V/V 
R, = 1.620 
J7 = 0.0067 0z-in.-s? 
Ky = 10.7 oz-in./A 
Kz = 0.0754 V/rad/s = 7.8 V/1000 rpm 


Kyacn = 0.056 V/rad/s = 6 V/1000 rpm 


Note that J; represents the sum of the motor and reflected load inertias. 
(See Section 3.3.1 for a discussion of reflected inertia calculation.) ) 

Let the desired final position of the joint be 7/2 radians, so that 84 
= 1.57/s. In Figure 4.3.8 it is observed that the joint is initially at ® it 
rad, so that the gravitational force produces no additional load on = ' 
motor. However, as @ increases with time due to the command sign* the 
gravitational disturbance also increases and is, in fact, proportional Ai e 
sine of 8. Fora particular joint geometry, we will assume that the mag ona! 
of this disturbance is 21 oz-in. so that the time variation of the grav! 
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Motorshaft 


Joint 


SS es ee ees ee 


Link 





Figure 4.3.8. Joint used in Example 
4.3.2. showing the effect of gravity as a 


Gravity function of angle. 


torque will be 
T,,(t) = 21 sin @(t) (4.3.12) 


The results of a computer simulation of the step response of the joint 
modeled in Figures 4.3.7 and 4.3.8 are given in Figures 4.3.9 through 4.3.13. 
The first of these figures shows the system with proportional control only. 
It is observed that as K, increases, the overshoot increases, as expected. 
Recall the discussion in Section 4.2.2. In addition, there is also a steady- 
state error due to the gravitational torque disturbance. As mentioned pre- 
viously, increasing K, reduces this error but at the expense of overshoot. 
This is clearly demonstrated in the figure. 

The effect of adding derivative control is shown in Figure 4.3.10 for a 
fixed proportional term (i.e., K, = 20). AS expected, the larger the damping 
(i.e., Kp), the smaller the overshoot. It 1s seen that it is possible to obtain 
a response with practically no overshoot (i.e., critical damping), but the 
steady-state error is still present and does not vary with K D: | 

Figure 4.3.11 demonstrates the effect of adding an integral term in the 
controller. Here proportional plus integral (PI) control eliminates the steady- 
state error with slightly increased overshoot. A PID controller is used in 
Figure 4.3.12. In this case the step response for different values of damping 
is shown for K, = 20 and K, = 75. Itis observed that it is now possible to 
obtain a zero steady-state error (i.e., the desired final position 1s actually 
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Figure 4.3.9. Step response of the system in Fig. 4.3.7 for proportional contro! 
only. 
cor 
achieved) with no overshoot for Kp = 0.02. For completeness, @ a Pl Figuie 
troller using different values of the proportional term is show? mn 
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1.57 


Joint Position (Radians) 





0 10 20 30 40 50 60 70 
Time (milliseconds) 
Figure 4.3.10. Step response of the system in Fig. 4.3.7 for proportional plus 


denvative (PD) control. 


A rule of thumb for selecting the parameters of the PID controller is as 
follows: 


1. With K, = K, = 0, adjust K, until the system step response is either critically 
(or slightly under-) damped. 
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Figure 4.3.11. Step response of the system in Fig. 4.3.7 for proportional plus 
integral (PI) control. 
error 8 


2. For the value of K, just found, increase K, until the steady-state K 
either zero or has reached an ‘‘acceptable” value. (Normally, K, 7 ont!) 

3. Increase K, until the system step response is again either critically or S¥8 
underdamped. 
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Joint Position (Radians) 





0 10 20 30 40 50 60 70 


Time (milliseconds) 


Figure 4.3.12. Step response of the system in Fig. 4.3.7 for proportional plus 
integral plus derivative (PID) control. 


com It is important to note that the PID controller can be synthesized using analog 

oe (e.g. , Op amps). Alternatively, the individual joint processors can 

sain “i the required proportional, derivative, and integral terms with appropriate 
actors by operating on the error signal (see Appendix C). 
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Figure 4.3.13. Step response of the System in Fig. 4.3.7 for PID control with two 
different values of | on 7 
4.4 FREQUENCY-DOMAIN CONSIDERATIONS 
. ; m 
It is often convenient and useful to look at the response of a robot axis serv® soil 
the frequency-domain point of view. he Jo" 


If the time or transient response of t 


7 oe al), 
aithfully track the command position ae 


is inadequate (e.g., the Joint will not f 
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¢ the magnitude and phase of the frequency transfer function versus frequency 
y reveal where the problem lies and compensation can then be added to 
(these graphs are referred to as Bode plots). 


4 4.1 Bode Plots 


Let us illustrate the frequency-domain approach through the use of an example. 
We begin by considering the tach or velocity portion of the position servo shown 
in Figure 4.3.5, consisting of an amplifier and servomotor. Assuming that the 
amplifier bandwidth is 1000 Hz (i.e., t4 = 1/6280) and that the motor in Example 
43.1 is used with an inertial load of 0.007 oz-in.-s? [i.e., J; in Eq. (4.3.5) is 0.0108 
oz-in.-s?], the tach open-loop transfer function is given by 


14.1AK, 
(1 + s/6280)(1 + s/44.14)(1 + s/439.73) 


The frequency transfer function (FTF) is obtained from this equation by substituting 
jw for s, where w, the radian frequency (having the units rad/s) is equal to 2af (f 
in hertz). The magnitude of the FTF, expressed in decibels [i.e., 20 log,o(|FTFI)] 
and its corresponding phase angle both drawn versus log, w are called Bode plots. 
This is shown in Figure 4.4.1 for the tach open-loop FTF. 

In Figure 4.4.1a both the straight-line approximation and the continuous plots 
are given for AK, = 1. The former is obtained by following a set of simple rules: 


GH(s) = (4.4.1) 


1. The FTF is placed in Bode form as shown in Eq. (4.4.2): 


M 
I] (1 + jw/o,) 

GH(jw) = Kgoae (4.4.2) 
I] (1 + jw/o, ) 
k=1 


where w, and w, are called the ‘‘break’”’ frequencies corresponding to each 
of the M zeros and N poles of GH(s), respectively. Note that the transfer 
function in Eq. (4.4.1) is already in Bode form. 


2. The magnitude of GH(jw) expressed in dB is then 


2 
M w N 
dB = 20 log (Kgoae) + p> 10 log E + (=) - >> 10 log 


Zi 


«r+ (2) | 


Where “log” implies “log to the base 10.”’ Note that multiple poles and 
“€TOS are permitted so that all of the Ww, S and/or w,’s need not be distinct. 


(4.4.3) 
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Figure 4.4.1, Bode plots for the open-loop tach described by Eq. Can e 
AK, = 1 and K, = 1. The gain and phase margins are also shown: (a) ™ = 

(in dB) vs. logy, w; (b) phase angle @ (in degrees) vs. logy. 
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3, For each of the terms 10 log (1 + [w/o cax}?) in Eq. (4.4.3), the following 
is assumed: 
. Oforw< Whreak (4.4.44) 
10log} 1 + (. = > 
- + 20 log foOrw~>Wpreak (4.4.46) 
Wbreak 


In Eq. (4.4.4b) the plus (minus) sign is used for the break frequencies cor- 
responding to the zeros (poles) of GH(s). As an example, in Eq. (4.4.1). 
the pole at 44.14 produces a term — 20 log (w/44.14) for w > 44.14. 


4. The straight-line approximation to the magnitude plot is obtained from Eas. 
(4.4.4a) and (4.4.4b) by drawing two lines, one having zero slope (in the 
range © < Wpreax) and the other having a slope of +20 dB/decade of frequency 
(in the range ® > prea.) for each of the terms in Eq. (4.4.3). These two 
lines will intersect at o = @,,..,. The resultant set of straight-line segments 
is then summed algebraically and the constant 20 log (Kg...) is added to the 
above piecewise linear curve, causing it to be translated up or down. Note 


that for a pth-order (i.e., multiple) zero or pole, the slopes will be + 20P dB/ 
decade. 


The exact magnitude plot can be obtained from Eq. (4.4.3) by evaluating this 
expression at representative frequencies or from the straight-line approximation 
itself. ‘The latter is accomplished by noting that for w < 7,24, OF © > 7Whreax: 
the actual and straight-line curves approach one another. (Thus the latter is, in 
reality, an asymptotic approximation to the former). The maximum deviation be- 
tween the actual and approximate curves occurs at w = ,,.,, and is equal to 3 
dB multiplied by the difference in slopes (in multiples of 20 dB/decade) on either 
side of the break. 


It is important to note that the results above are valid provided that: 


1. Successive break frequencies are separated by a factor of about 7, so that 
they do not “interact”? with each other. If this is not so, the error between 
the actual and straight-line plots at the break frequency will not be 3 dB times 
the difference in slopes. 


2. All of the zeros and poles of the open-loop FTF in Eq. (4.4.2) are real 
numbers. If instead, some are complex quantities (appearing in complex 
conjugate pairs), the actual plot may be significantly different from the straight- 
line approximation in the vicinity Of Wpreax- In fact, the true plot may actually 
exhibit a resonance. This situation will not be considered here. However, 
the reader who is interested in further information is referred to any one of 
the several references listed at the end of this chapter. 


It is also possible to develop a set of simple rules for obtaining the approximate 
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This will not be discussed in this chapte P.q 
r, how 


phase versus frequency curve. 
d an excellent discussion of the subject i, . ¥ve 
i 7 
n Dors (1) 


The reader can, if desired, fin 


4.4.2 Gain and Phase Margins 


Two measures of relative stability for a system, the gain and phase maro; 
and PM), can be obtained directly from the Bode plots and are defined (GM 
S 


GM = —20log(|FTF)) at »,, 
PM = 7 — angle ofFIF atw, 


n frequency for which the phase angle of the FTF (fo, th 
e 


open-loop system) is 7. Also, the FTF is unity (i.e., 0 dB) at w,. Physicalj 
GM tells the designer how much the gain (i.e., Kgode) Can be increased before Pa 
closed-loop system becomes unstable. Similarly, the PM indicates how ae 


additional phase lead can be tolerated before instability results. Usually, if both 
d-loop system will be stable. If either or 


the GM and PM are positive, the close 

both are negative, the closed-loop system will probably be unstable. A commonly 
used design objective is to adjust (i.e., compensate) the open-loop system so that 
its GM = 20 dB and the PM = 45’. 

Applying the definitions in Eq. (4.4.5), the GM and PM for the tach loop in 
Figure 4.4.1 are 21.6 dB and 47°, respectively (see Problems 4.10 and 4.11). These 
results imply that the tach closed loop is stable provided that AK, < 12. (This can 
most easily be seen by understanding that increasing the gain AK, by NdB 1s 
equivalent to shifting the entire magnitude plot vertically NdB. Although the 
phase plot is not affected by the gain change, the GM and PM will change.) 


(4.4. 5) 


where w, is the radia 


4.4.3 Approximate Closed-Loop Frequency Plot 
the closed tach loop can quickly 


on to the frequency response for 
for the general feedback system 


he open-loop plot by noting that 
losed-loop transfer function is given by 


eee. Se (4.4.6) 
TU) “TF G(jw) He) 

. 7 

r function is large [i.€-; G(jo)H (jo) 7 


An approximati 
be found from t 
in Figure 4.4.2, the c 


When the gain of the open-loop transfe 


+ : 


Figure 4.4.2. General form of a closed-loop system. 
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Figure 4.4.3. Approximate magnitude plot for the closed tach loop in the example 
in Section 4.4.1. The result is obtained from Fig. 4.4.1a using the approximations 


in Section 4.4.3. 


1], T(jo) is approximately equal to 1/H(jw), whereas it is approximately equal to 
G(jw) when G(jw)H(jw) << 1.* The easiest way to determine the approximate 
closed-loop response using these ideas is to obtain the piecewise linear plot and 
then, from this, draw in the continuous frequency curve. The approach to follow 
is that for all frequencies such that the magnitude of G( jo) H( jw) > 1, the straight- 
line plot is found from 1/H(jw) using the rules presented in the preceding section. 


It is worthwhile noting that if H( jw) is a constant, as is often the ay = 
of the response will be a horizontal line at 20 log [MAGoll. bi eon : 
quencies, T(jw) is G(jw) and the piecewise linear plot is obtained Irom ~ 
| for the open-loop transfer function of rigur 


Making use of this technique : - Eonre 4.4.3, Note 
ae shown in Figure 4.%.2. — 
4.1 results in the caalbec pe Sees isa the 0-dB level because It was 


that the horizontal line to the left of 529.1 rigure 4.4.1). If this is not sO 
assumed that both K, and AK, were unity (see IpU - 4.4.3 is at —14 dB tor 
(e.g, AK, = 1 but K = 5), the horizontal line 10 pays problem 4.12). 
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Ch 
Recalling that the break frequencies occur at the poles or ZeTOs “Pq 
function, the approximate tach closed-loop transfer function can be ob € trap 
this figure. Thus ° laingg fe 

0 

1 th 


G tach (s) 7 (1 + s/523.1)2(1 + 5/6280) (4 


Note that the double pole at 523.1 occurs because the slope of the « 

plot changes from 0 to —2 at this frequency. It is important fo, the te hting 
understand that the continuous curve shown in Figure 4.4.3 is What one Teade, to 
for the FTF of Eq. (4.4.7). However, it is still an approximation of Would Bet 
closed tach loop response. the Actua) 


4.4.4 Bandwidth and Tracking Error Considerations 


Often, the bandwidth of a system is defined as the frequency where the re 

1s down from its peak value by 3 dB. Using this definition, it is seen from — 
4.4.3 that the closed-loop tach bandwidth is about 336.7 rad/s or 53.6 Hy = 
that the motor bandwidth was 44.14 rad/s or 7.03 Hz. Thus it is observed rs 
closing the loop has significantly increased the bandwidth of the system. This . 
of course, a well-known result. ‘ 
| A more important point to remember is that the bandwidth limits the may. 
imum speed with which a system can respond to an input signal. That is, if the 
input requires a rapid change (with respect to time), the system must have sufficient 
bandwidth to follow (or “track”) this command. Otherwise, the response will 
significantly lag behind the command input, thereby producing a large “tracking 


error.” 

An example of such behavior is shown in Figure 4.4.4. Here the effect of 
moving the single system pole is observed. In Figure 4.4.4a, the pole is located 
at s = —2 (bandwidth = 2 rad/s), whereas in Figure 4.4.4b it is at s = —0.9 
(bandwidth = 0.5 rad/s). Note that the tracking error is much smaller for the 
first case (where the bandwidth is larger). 

Amplifier saturation and sluggish performance are possible consequences of 
large tracking error. Moreover, in robotic applications, this quantity is often 
monitored in order to determine whether the manipulator is actually moving hee 
has it hit an unforeseen obstacle or is the load too large to handle?). If the join! 
normally exhibits a large tracking error because of insufficient bandwidth 1n 7 
servo loop, the criterion for automatically halting the manipulator motion rae 
relaxed. This can have serious safety consequences and can also permit — 
to electrical and/or mechanical components. In addition, if the trackiné error 
all of the joints of the robot is not the same, it will be virtually imposs!?"” 
robot to move its end effector in a straight line. ta 

In more mathematical terms, if it is required that at least a certain per 
of the total energy contained in a signal be “passed” by a system in — s fo 
reproduce it faithfully at the output, and the frequency at which this 0° 
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Figure 4.4.4, Illustration of the effect of system bandwidth on tracking error: (a) 
t= 25 (b>) a = hs. 
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then the system bandwidth must be at least equal to f, to ensure that th a“ 
transmitted without significant distortion. The common definition of a 
(i.e., 3 dB) is used because the ‘‘half-power”’ frequency occurs whey th . 
of the system is down by 3 dB. However, it should be noted that the ne SPonse 
based on this definition may not produce an adequate reproduction of is Awidth 
and something far more stringent may be required. For example, if it le Signa| 
that 98% of the energy content of the input must be transmitted (instead of 
in Order to produce adequate tracking of the signal, the required system ‘Shi 90% 
will be much higher than that predicted by the 3-dB criterion. ndwidth 

As the system in Figure 4.3.5 is a position servo, we are really interesteg ; 
the frequency response of the position loop. Therefore, once again ref = 
this figure and also using Eq. (4.4.7), the open-loop position transfer fine: 7 
found to be _— 


Signal is 


K 
GETS) ccxition ms ~ G(S)tach 


K, 


— 2 (4.4.8) 
14+——)f1+— 
J 523.1 6280 


The magnitude and phase plots (for K, = 1) are shown in Figure 4.4.5. 

The gain and phase margins for this loop are found to be 59.1 and 89.8’, 
respectively. From a stability point of view, it appears that the position loop will 
behave more than adequately. However, closing the loop will produce a 3-dB 
position bandwidth of less than 0.16 Hz (1 rad/s). Thus, the joint will only be 
able to track slowly changing position commands (e.g., those that require about 
1 s to reach about 63.2% of their final value). This response may be inadequate 
for the joints of a high-speed robot, so it is necessary to increase the position loop 


bandwidth. 





4.4.5 Compensation of a Position Servo 


A simple way to raise the closed-loop bandwidth is to increase the position oe 
constant K,. Such a procedure is referred to as gain compensation. For ae 
if K, = 70 (37 dB), the GM = 22.2 dB and the PM = 74.4°. Using the apP 
imation described in the preceding section for closing the loop, th 
bandwidth is about 10.8 Hz (67.5 rad/s), so that the joint will respond to 
commands that reach 63.2% of their final value in about 15 ms (1/67-5)- FOU", 
robotic joints, this is more than an adequate response time. FOr exer m 28 
U.S. Robots’ Maker 100 (e.g., see Figure 1.9.6) has a bandwidth of BpOU di ‘5 a 
Hz (for each of its joints). The reason for the range is that joint ban pes not the 
function of the load and also the geometric configuration [i.e., whether ° 
manipulator is fully extended (which produces a lower bandwidth)]- 


If for some reason a bandwidth of 10.8 Hz is not large enough, the P 
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Figure 4.4.5, Bode plots for the open position loop described by 
ep = Is (a) magnitude plot; (b) phase plot. 
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| | ap, 

gain constant can be further increased. For example, if K, = 49 dB 
19.1 dB and the PM = 68.2° with the closed-loop bandwidth about 1 4 hag GM . 
a stability point of view, this value of K, would be about as large 7 He 





a ‘0 
able to use. A still larger bandwidth could only be obtained by other ~ Would 
lead compensation). MEANS (e,9 
As an example of this technique, consider the transfer function 
compensator described in OF a leag 
1+ sa 
r = 
lead) 1+ sb (4.4.9) 


where a > b. Although the compensator can be placed in either the tach or Positi 
loop, suppose that we use it in the former. The position servo of Figure 4.3.5 becom 
that shown in Figure 4.4.6. The break frequencies 1/a and 1/b must be selecteg $0 
that the compensator increases the closed tach loop bandwidth. From Figure 44 
it is seen that the zero should be placed somewhat before the second break frequency 
of the open-loop tach FTF (i.e., 439.73 rad/s) and the pole after the 0-dB crossover 
frequency (i.e., 523.1 rad/s, e.g., 1/a = 250 and 1/b = 2500). The piecewise linear 
approximation to the magnitude plot for the open tach loop with and without this 
compensation is shown in Figure 4.4.7. Also shown in the figure is the approximation 
to the magnitude plot for the closed tach loop. 

The closed-loop tach bandwidth is found (using the approximation in Section 
4.4.3) to be 147.6 Hz (up from 53.5 Hz) and the GM = 19.2 dB and PM = 34. 


From Figures 4.4.5 and 4.4.6, the position open-loop FTF is found to be 
K, 
Gane = jo(1 + jw/1094.8)(1 + jo/2500)(1 + jo/6280) 
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Figure 4.4.6. Position servo with lead compensator in the tach 
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Figure 4.4.7. Piecewise-linear approximation for tach loop of system in Fig. 4.4.6 
with and without compensation. Also shown Is the closed-loop tach response. 


Using this equation with K, = 40 dB, the (position) gain and phase margins are 
found to be 27.6 dB and 81.6°, respectively, with the closed-position loop bandwidth 
now 15.7 Hz. Thus the position servo bandwidth has been slightly increased by 
using lead compensation. However, since the phase margin is also higher, it is 
also possible to increase the position gain constant (to 47.6 dB). Doing this results 
ina GM, PM, and closed-loop bandwidth of 20 dB, 70.6°, and 36.0 Hz, respectively. 
Clearly, the use of simple lead compensation has more than doubled the bandwidth 
while not affecting the relative stability of the closed-loop system. Thus the joint 
could, if required, respond to command signals having significantly higher fre- 
quency content than before (i.e., it could be made to move considerably faster. 
See Problems 4,15 and 4.16.) 

Before leaving this topic, it is important to understand that a large bandwidth 
may not always be desirable. For example, it is well Known that high-frequency 
interference (noise) will adversely affect the performance of a system if its band- 
width is too large. Also, where a digital-to-analog converter (DAC) is employed, 
it is Critical that the servo not respond to each individual piecewise constant update 
from the DAC. Thus it is often necessary to place an upper limit on the system 
bandwidth in order to ensure proper performance. 

In looking at the performance of a robotic joint from a frequency-domain 
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; D.q 

point of view, we tacitly assumed a particular structure for the servo hes 

is possible to configure the servo in many different ways, and this jg the face 
lect 


) It 
the next section. 


Of 


4.5 CONTROL OF A ROBOTIC JOINT 


In the previous sections, it was assumed that the position and velocit 
was “‘available” with no thought being given as to how one actual] 
information. Also, it was assumed that all components in the Positi 
analog devices. Although this is useful in the analysis of servo | 
usually the case in practice. What is normally done in a robotic j 
utilize either a digital approach where all sensory information j; 
processed in a digital fashion, or else both analog and digital tech 
to obtain and process information. 

Regardless of the scheme employed, however, the command Signal to the 
joint servo of a robot is invariably obtained from a microprocessor (i.e., the “mas. 
ter”) and is, therefore, digital in nature. It is important to understand that thi 
implies that the input to the joint is not a continuous-time function but is, instead, 
a “sampled” signal which is updated (i.e., changed) only periodically (e.g., every 
25 ms) by the master or a special math coprocessor. Such an approach is taken 
because the master must send information to all the jOint servos (e.g., six ina six- 
axis robot). Consequently, it must have enough time to complete the various 
computations required in the path planning algorithm and then to communicate 
this information to the individual joints. We will call the update (also referred to 
as either a sample or set point) time T.. 

Although it is quite feasible to convert the digital position command into an 
analog signal by using a digital-to-analo g converter, this is not often done. Instead, 
the individual joint processors themselves perform an interpolation between tw? 
consecutive set points output by the master. For example, if T, = 25 ms, the 
interpolated set points might occur every 3.33 ms (T,/8), implying that the tt 
update interval is divided into eight subintervals. Asa consequence, considerapy 
smoother manipulator motion is produced. ther 

In practice, it is possible to obtain both position and velocity data in © 
an analog or a digital fashion using the same or separate devices (i.e., Se0S°™ 
monitoring these signals. We now consider several different possibilities. 


y informati On 
y Obtains this 
ON Servo Were 
SPS; it is Not 
Olnt SErvo is to 
S Obtained and 
niques are Used 


4.5.1 Digital Position and Anal 


Og Velocity: Separate 
Sensors 
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A configuration that is often €ncountered in equipment used today by the ont fot 

tool industry (e.g., xyz incremental motion devices) utilizes separate sem 


Digital 
Position 
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monitoring velocity and position. An optical encoder (or some other digital po- 
sition sensor; see Section 5.3.2.2) mounted on either the motor shaft or output 
(1.€. , workpiece or tool tip) is used to produce a digital representation of the current 
position. Velocity information is provided through the use of an analog tachometer 
similarly mounted. Since the information from the latter device must be converted 
into digital data in order to be utilized by the joint processor, an analog-to-digital 
(A/D) converter may have to be employed. 

For the joint servo in a robot, the command signal from the master computer 
is digital in form. As mentioned previously, the joint processor uses this input 
together with the position and/or velocity information to produce an error signal 
which is used either directly or indirectly as the input to the servo (power) amplifier. 
Two approaches are possible. 

In the first case, the joint processor uses both the position and velocity in- 
formation to produce a velocity error signal, which is in turn, used as the drive 
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Figure 4.5.1. Two realizations of a joint position servo utilizing digital position and analog 
velocity information: (a) both wand @ are digitized and fed back to the joint processor to 
obtain the velocity error signal; (b) only the digitized value of @ is used to produce the velocity 
command. Then, this is compared to the analog value of w to obtain the velocity error 


signal. 


Ch 
» the tach «: *P, 
Xa that an A/D converter IS required (note that this prod = - St be g: 

© continuous tach Signal). After the joint Processor co a Sa led ye, vttizg 
$10ns of the Current actual position and veloci — ee 
Cf€ived from 


“delta time” and here “delta time” = T,.) The velocity com 
Converted into analog information usj 
necessary if a PWM amplifier is employed). An analog velocity error js created 
by comparing this signal with that fed back directly from the tachometer. The 
Comparison is usually performed using analog hardware (€.g., an operational am. 
plfier). Both of these cases are illustrated in Figure 4.5.1. Note that the second 
case shown in Figure 4.5.1b Substitutes an op amp for an A/D converter. A cos 
Saving can be realized by taking this approach since the tach provides a continuous 
flow of velocity information, whereas the A/D converter only gives the informa 
it j les of the tac 
at the sampling times. If it is necessary to have closely Spaced samp anipolator 
signal in order to maintain proper tracking of the joint and/or smoother eae = 
performance, a high-speed A/D converter may be required ign dollar 
compared to that of an op amp (e.g., tens of dollars as compare 


‘al would be 
for the op amp; recall that for an N-axis robot, this cost differentia 
multiplied by N). 


4.5.2 Measured Digital Position and Derived Digital 
Velocity: Single Sensor 
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alone). Since weight and volume in a robot joint directly influence the size and 
cost of many mechanical and electrical components, anything that increases these 
quantities must be justified from a performance point of view. In certain instances 
it is possible to obtain the same dynamic performance without resorting to the 
extra piece of hardware. Consequently, there may be a considerable savings in 
volume and weight, and it is therefore not surprising that many robots today do 
not employ analog tachometers. 

How can we apparently “have our cake and eat it too” since, in an earlier 
section of this chapter, we learned about the need for velocity feedback? ‘That 
is, how can the velocity information be obtained without using a tachometer? The 
answer to this question is found by recalling that velocity is the time derivative of 
position and also that a first-order approximation to a derivative is given by 


(2) approx = = (4.5.1) 


In practice, position is measured by reading the encoder count at specific (sampling) 
instants of time (e.g., either T. or the time between interpolated set points). If 
the joint processor takes the current position count and substracts it from the one 
obtained at the previous time, this difference represents AO. Usually, the time 
between samples is fixed, so that AT [in Eq. (4.5.1)] is always equal to one sampling 
instant. ‘Thus A@ obtained in the manner above is, in reality, directly proportional 
to an approximation of the angular velocity, OW) scorox: 

As might be expected, there is a “price” to be paid for doing the above. 
That is, the approximation to the tach signal may be inadequate, and difficulties 
may result. An example will illustrate the potential problem. 


SS SS 


EXAMPLE 4.5.1 

We wish to calculate the effective resolution of the digital position and velocity 
information when a 200-line optical encoder is placed on the shaft of a motor 
that is used to drive a particular joint of a robot. Suppose that, in addition, 
a 50:1 gear reduction is used to couple the axis output to this motor and that 
it takes 40 motor revolutions to cause the axis to move from one motion limit 
(or extreme) to the other (these are often referred to as stops or limit stops 
and be of either the hardware or software variety). Consequently, the axis 
can move a total of 288° ([40/50] x 360). Thus the encoder wil] generate a 
total of 8000 (200 x 40) lines or counts over the entire range of travel, which 
implies that the joint processor (and associated digital hardware) must have 
the ability to count this number. That is, they must be able to handle a 13- 
bit number representing the joint position. In this case the smallest change 
in angular position of the axis that can be obtained is 0.036° (288/8000) and 
the position resolution is said to be 0.036°. 

Now let us suppose that the scheme for deriving the velocity signal 
described above is employed. If it is assumed that the maximum velocity of 
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ha 
the joint is 20 motor revolutions per second (= 4000 lines/s) 7 
master processor is sending out position updates (set points) eve, “Ten if the 
maximum change in position count between any two samples ah the 
100 counts. Thus the maximum velocity will be represented by g bps abou 
and will have a resolution of 0.072°/s. More important, it is reco itnum 
the difference between the current and previous position counts sil that 
smaller during the acceleration and deceleration phases of the RiGee Muc 
the joint is moving at velocities well below the maximum. Asa soiekn When 
the approximate velocity derived in this manner during these fines Uence, 
significantly less than 7 bits (e.g., 1 or 2 bits to begin with). Will be 

The effects of reduced velocity resolution and quantization are jl 
trated in Figure 4.5.2a and b. Here the ideal quantized velocity js shane 
by taking the difference between the current and previous samples 72 
ideal continuous position signal [= A (actual position)] and then quantiz; e 
the result (i.e., “integerizing” it). Often, however, the actual Position © 
quantized before the differencing operation between current and Previous 
position is performed. This produces the quantized velocity curve shown in 
the figure. It is observed that although the ideal velocity signal is a continuous 
function of time, the approximate velocity derived from the encoder (position) 
signal is piecewise constant or a “‘staircase’’ function. 

Now it will be recalled that the tach gain must be increased in order to 
increase the damping and hence reduce oscillations in the joint. Therefore, 
the 7-bit number representing the joint velocity will have to be multiplied by 
some factor. For example, suppose it is found that a K, of 16 is required in 
order to produce the proper performance. Because of the quantizing effect 
of the procedure described above, the initial value of the amplified tach signal 
will be zero and will then jump several sampling instants later to 16 and stay 
at that level for several more sampling times (see Figure 4.5.2). The effect 
of a staircase damping term in the velocity loop may well produce undesired 
oscillations in the joint response and could even cause it to become unstable. 
Thus even though increasing the tach loop gain should reduce the oscillations, 


it is seen that quantizing may actually cause the problem to become worse. 


a tial 
Several techniques can be employed to reduce or eliminate this poten 


problem. These include: 
: . is tion 
1. Increasing the resolution of the encoder by using “times 4 logic (see sac 
5.3.2.2) and/or increasing the number of lines on the encoder disk. 
second method can significantly increase the cost of the encoder. stable 
2. Reducing the maximum value of K, (which may cause the joint to mn ction 
but still more underdamped than is desirable—recall the discussion © 
4.2.2). ual 
3. Obtaining a better approximation to the velocity, that is, using a se 
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16). [Note: quantized velocity = 0 ‘et 
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: ive (which °D. 4 
scat derivative (which may require «:__. 
mation to the —_ 
higher-order approx! nan ey 
‘ncreased computation [I 
4, Using two or more different 
acceleration (and deceleration 


It is worth noting that the problem of ae signal re 
also arise during the constant-velocity portion of the joint motion, Th re Can 
for this is that it is often necessary to operate a robot joint (or joints) at less ri 
maximum velocity; for example, when the maximum payload is being cattieg 
the gripper or in a spray-painting application where the thickness of the pie: 
in part, determined by the linear speed of the sprayer. In this instance th Sn Is, 
of bits of velocity information is reduced and a situation similar to that a 
observed during acceleration and deceleration of the joint can occur. Ich jg 


values of K,: for example, a small on 
and a larger one during constan ‘Urin 


Solution 


4.5.3 Measured Analog Velocity and Derived Analog 
Position: Single Sensor 


Although a tachometer is usually much larger and heavier than an encode 
relatively high cost of the latter device might make eliminating it from the — 
quite an attractive idea. If this was done, the tach would have to be edt 
provide both the velocity and position information. An Op amp integrat yeh 
be used for this purpose since position is the integral of velocity. Senor Ould 
When position is obtained indirectly by sensing velocity as described above 


1. Op amp drift as a function of time. 
work shift might be affected significan 
2. Nonideal integration. It is clear that 


lity during the course of a 
y. 
accuracy would suffer in this case. 


If these proble 
MS could 
formation could be used directly the ‘ome, the analog position and velocity 1™ 


Position a i 
Processor provided Ph nal. In this case y might tee D/A conversion of the digita 
i ; at a Ignt be Bcd join 
with analog circuits (¢ equate smoothing of th Possible to eliminate at e 
‘nals would perm; ath a filter) " € D/A output could be ac sins 
Processor j ©m t , Cc oth an 
OF In @ manner Similar to Mpared with the atid cued jib n the joie 
Mat described in Section 4 51 Clearly. ™ 
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success Of this configuration would d 


pend on bei ble 
(with respect to time) position infor , being able to get accurate and sta 


mation. 


4.5.4 Measured Analog Position and Der; 

Velocity: Single Sensor on 
As already mentioned, the cost of the 
Consequently, eliminating both of the 
something less costly is an extremely at 


encoder and tachometer is not insignificant. 
Se sensing elements and replacing them with 
tractive idea. In fact,there is an inexpensive 
method of measuring the position of a rotating shaft, that is, by using a rotary 
potentiometer (or “pot”’) which produces a voltage that is proportional to shaft 
angle. This device 1s discussed more fully in Section 5.2.1. 

If position Is measured in the foregoing manner, the velocity information can 
most easily be obtained by differentiating the pot output. For this purpose, an 
op amp can be used. A problem with this approach is that a differentiator is a 
high-pass filter, and hence it tends to preemphasize electrical noise in the system. 
Another potential problem is that pots are inherently noisy devices with relatively 
limited life. ‘This is due to the fact that the wiper (i.e., the moving member) must 
physically touch the resistive element. The contact deteriorates with time, be- 
coming dirty and nonuniform, and produces signals that can be exceedingly un- 
reliable. Consequently, of the four configurations discussed, this is the one that 
is the most difficult to use. 

To summarize this section thus far, four different techniques of obtaining 
position and velocity information that can be used to control the joint of a robot 
have been presented. Only the one described in Section 4.5.2 is purely digital in 
nature. The remaining three are hybrid schemes involving some analog and some 
digital aspects (although in the last two, only the command signal is digital). Of 
the four, the first two are commonly employed in a variety of incremental motion 
applications (e.g., x-y tables). Many of the robots on the market, as of this writing, 
use the all-digital approach, primarily because of the added cost, weight, and 
volume of a separate tachometer. 

At this juncture, a point worthy of mention has to do with the actual placement 
of the position and/or velocity sensors. It was Stated previously that these devices 
can be placed either on the motor shaft or at the drive output. The major advantage 
in monitoring the work output is that, in principle, it permits careful control of the 
end effector by providing information about what is actually happening at the tool 
tip. Thus disturbances and oscillations should be handled quite well. On the 
other hand, using sensors on the motor shaft means that we control’ only the 
motor output. The tool tip is ‘“unobservable.”> We make the assumption that the 
Joint output and hence the tool tip follows the motor exactly, implying that there is 
almost perfect rigidity among mechanical members. Clearly, this is not correct 
and yet, most robots, and for that matter, most incremental motion devices, utilize 


this approach. 
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C 
The most important reasons why this should be so are as follows Nap 
1. It may be physically difficult to mount the encoder and/or tach 
end of the drive. This is particularly true in the wrist axes ir _ 
at a premium. CTe ¢ - 
If 


2. Mechanical nonlinearities such as gear backlash, Coulomb frict 
rigid linkages may produce a “limit cycle” or “ratcheting” type an nd no 
It is possible to compensate for such an instability by injectip Oscillation 
quency OF “dithering” signal into the servo. Despite this, it Pi a hi fe 
practice to monitor position and velocity at the output of a robot ioin Commo, 
because the mechanical components tend to deteriorate with int Probabj, 
consequence, the robot could become suddenly unstable, creatin Use. Ag, 
safety hazard. 5 4 Significan 

3. Increased position resolution resulting from the multiplication of th 
resolution by the speed reduction ratio of the coupling device (e © encode 
train). See Chapter 5 for a more in-depth discussion of this fomeieans : on 

n 


4. Reduced problems due to ‘digital jitter” (i.e., digital limit cycle). This ; 
discussed more fully in Section 5.5. i 


Before leaving the topic of the control of robotic joints, a brief discussion of 
adaptive control and optimal control is in order. The former topic is discussed ir 


the next section. 
4.5.5 Adaptive Control 


Up to this point it has been assumed that all gains and parameters associated with 
the joint servo of a robot are fixed with time. In fact, this is true for virtually 
every manipulator currently being manufactured. A number of robot controllers 
do permit the user to specify the load (weight) before performing any move Op- 
erations. Parameters that give the best (compromise) performance are then dow! 
loaded from a table located in memory. Once these quantities are set, howevel 
they are usually not modified unless the machine is informed (by the operator) the 
the load has been changed. 
Previously it was stated that robot controllers and actu a from 
designed assuming that inertial loads are constant, even though this 1s far we 
valid, as was seen, for example, in Figure 43.4. As a consequence: motor h 
be more conservatively selected (i.e., larger) and performance may SU = ‘vel 
ig, it might not be possible to move the end effector as fast as desired wit ae 
load, and/or the motion might not be as smooth as required. * justine 
could dynamically compensate for inertial load variation by co ° 
servo parameters, improved operation characteristics would no 0 arati0 
Although not currently done, one approach for improving t ae 
a robot would be to utilize adaptive control whereby the system re ae 
itored and parameters and/or gains modified continuously in time S° oF 


ators are almost always 
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the “best or optimum” results, e.g., the fastest possible motion from one point 
in space to the other with the least amount of vibration (for a specific actuator). 
Most often, this adaptive approach produces an overall system that is both nonlinear 
and time varying, so that the analysis and synthesis problems tend to be quite 
complicated. 

In the case of a robot, where movement is restricted to its workspace and 
the motion profile 1s well defined and known a priori, it might be feasible to design 
preprogrammed time variations of controller parameters to achieve an instanta- 
neous optimum control at all times. Such an approach, referred to as prepro- 
grammed adaptive control, has been used for years in the field of missile guidance. 
It is noted that this scheme would be used in addition to normal feedback procedures. 

In many instances, memory and/or computational time constraints would not 
permit the system parameters to be varied continuously with time. In such cases, 
a zoned adaptive approach could be adopted whereby the entire workspace would 
be divided into a finite number of distinct subspaces or zones. Then gains and 
parameters could be changed in a predetermined manner as the manipulator moved 
from one of these previously defined zones into another. Clearly, this technique 
would require far less memory and computation time than the continuous one. 
Since parameter values would change abruptly as the system entered a new zone, 
care would have to be taken to prevent such an action from introducing unwanted 
vibrations. 

The adaptive procedures described above are relatively simple and depend 
on being able to predict the motion of the manipulator beforehand. It is possible, 
however, that unforeseen variations in the system and/or the work environment 
(e.g., noise), could occur which could not be handled by the preprogrammed 
adaptive scheme working in conjunction with a standard feedback controller. In 
this case, another adaptive approach that has been applied to other systems is 
potentially applicable to robots. Specifically, a measure of the system operation, 
called a performance index (PI), is constantly monitored and system parameters 
adjusted so as to optimize in some manner (e.g., either minimize or maximize) the 
PI. Once again, the adaptive control loop formed in this way would operate in 
addition to the normal feedback scheme used to control position. Note that the 
AGC (automatic gain control) in radio, which adjusts the receiver gain so that its 
output level is relatively constant over a wide range of input signal amplitudes, is 
an example of such an adaptive system. 

A robot control system with a general adaptive controller added is shown in 
Figure 4.5.3. Here the adaptive control is used to compensate for time variations 
in the robot’s transfer function which are produced by the environment and un- 
predictable component variation due to wear and manufacturing irregularities. By 
monitoring the performance index (this is sometimes referred to as “the identifi- 
cation process”), the effects of these factors on the robot’s operation is measured 
continuously. The decision logic is then used to evaluate this information and 
determines how to modify the controller's parameters so as to produce an optimum 
response (e.g., in the desired position). Alternatively, the modification process 
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Figure 4.5.3. Adaptive controller added to a normal position feedback contro] 
loop (represented by the system transfer function) of a robot. 
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(Identification) 


can be used to adjust the control input to the robot itself to produce “ 
performance. In general, adaptive controller design involves the choice of a phys- 
ically meaningful and computationally tractable PI, selection of a controller topology 
and the set of appropriate parameters to be adjusted, and finally, a method of 
dynamically adjusting those parameters. 

Another variation of the adaptive approach, shown in Figure 4.5.4, is called 
a model reference adaptive control system. In this instance it is assumed that a 
known (reference) model of the actua] system exists that has the desired response 
characteristics to the command signals. Then an observed response error signal 
is generated by comparing the Output of the model to that of the actual system. 
Note that the latter is often “corrupted” by noise. An adaptive controller utilizes 
a function of the error (i.e., some previously defined PI) to modify parameters so 
as to obtain a more optimum response. Obviously, the success of this scheme !s 
quite dependent on being able to model the robot system accurately. Model 
reference adaptive control has been used successfully in a variety of applications: 
including aircraft autopilots. 

Despite the obvious advantages of being able to compensate for system com- 
ponent variations and environmental disturbances. adaptive control of commercl@ 
robots is not now utilized. The major reasons for this are as follows: ; 

1. Significant cost of developing the adaptive control hardware and sof ne 
Manufacturers of manipulators do not have the personnel to handle the “ the 
work load that the implementation of adaptive control would require. Also, nil 
robots currently being produced are perceived (by the companies) to b¢ AF ify 
enough”’ for the applications of today. Thus industry finds it difficult to JU 
the additional cost associated with adding such technology. (Fortunately — 
sity and government laboratories have not been as shortsighted). 
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Figure 4.5.4. Model reference adaptive control of a robot. 


2. The added computational burden placed on existing microprocessor sys- 
tems. Even though most robots currently manufactured utilize distributed proc- 
essor architectures, there is barely enough computing power to handle the work 
load now. Since adaptive control is often quite computationally intensive, it is 
clear that robot controllers would be hard pressed to complete all the required 
computations during each update. In the future, however, as more powerful 
microprocessors become cost-effective, it is safe to assume that inadequate com- 
putation time will no longer be a deterrent to implementing adaptive robotic con- 


trol. 


4.5.6 Optimal Control 


seeks to make a system perform in the “‘best 
ferred to as optimal control because the 


fa’ tem in some 
designer attempts to find the input (or inputs) that a ae aaces the 
sense, In general, it is necessary 10 aa a “nitial point in space to a 
desired performance (e.g., drives the system ~~ pe ecified. In addition, it 1s 
second point). Both of these points are generally eal performance index be 
usually required that these inputs be such that a aes be necessary to perform 
minimized or maximized (i.e., optimized). Finally, samvantels on the inputs and/or 
this optimization in the presence of one OT maga magnitude of the input could 
the System states and/or outputs. For example, 


be limited by the de supply voltage. 


Another important area of control s 
manner possible. This discipline 1s re 
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There are a number of different classes of optimal controls 
one is Ame optimal control, where the engineer seeks to find the vom ©Xamp|, 
the given system from point A to point B in the shortest time While w te 
input constraints (e.g., magnitude, fuel, etc.). A second example. th Ying i 

’ e e 


optimal control, involves finding the input that moves the system, ing ery 
manner (i.c., over a specified ‘‘trajectory’’) and minimizes the ener CSirey 
by the control. sd “XPendey 


The literature contains numerous applications of optimal Control to ph... 
systems. However, little work has been done in the area of robots Physic 
because of the extremely heavy, real-time computational load incurred * abl 
tempting to determine the control parameters. In this respect, the Carlier disc 
sion on adaptive control is pertinent. A few researchers have looked at trying ty 
optimize overall motion time for arobot. Besides the computational burden shies 
on the already overworked low-level microprocessor systems currently utilized in 
robots, mechanical constraints place severe physical limitations on Manipulator 
speed. For example, linkages, gears, harmonic drives, and so on all have torque, 
speed, and/or acceleration limitations that might be difficult to model completely 
so that a meaningful optimal control could be found. Thus it is not too surprising 
that this type of optimization has not been stressed in robot design. 

Some interest has centered on the time optimal control of certain robots that 
do not need to perform coordinated motion (i.e., simultaneous movement of two 
or more manipulator axes in order to arrive at the desired endpoint). In ths 
instance the individual joints are moved sequentially in time, and what 1s sought 
is the sequence of separate joint motions so that the overall motion time 1s minh 
mized [2]. . 

As in the case of adaptive control, it is likely that as the computational pow" 
of robot controllers increases, it will become more feasible for commercial ore 
to utilize optimal control. Before this becomes a reality, however, it will yell 
necessary for novel mechanical structures and materials to be developed that iat 


. cj d : 
high-performance manipulators to withstand the extreme stresses ef ae pro 
S 


powe! 


an optimal trajectory 1s being executed. Although these development abt, 0% 
ably not occur in the short term, optimally controlled robots will, no ¢° 
day be a reality. - axis to m0¥ 
Thus far, it has been assumed that the device causing a robotic in com yer 
is a dc servomotor. Although this is a valid assumption for a number . In 
controlled robots, there are other types of actuators currently or sain 
next sections we consider several of the more commonly used techni 
4.6 STEPPER MOTORS vel 


is 
only 7 fol" 


“assume ee 
Oa ice 


n 
tepwise mat 4 de’ 
snce such ® 

que 


Ji as possible to construct a motor in which the rotor is able ¢ 
stationary angular positions. Rotary motion occurs In a > 
one of these equilibrium positions to the next, and as a conse 
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is called a stepper motor. Although to date, these actuators have been used in 
only a few robots (e.g., the Merlin manufactured by the American Robot Cor- 
oration), they have been employed in a variety of applications, the most notable 
of which is in the field of computer peripherals (e.g., printers, tape drives, capstan 
drives, and memory access systems). Steppers have also been used in equipment 
related to the areas of process control, machine tools, and medicine. 
There are several general characteristics of a stepper motor that have made 
it the actuator of choice in such a large number of applications: 


J. The device can be operated in an open-loop manner with a positioning ac- 
curacy of +1 step* (assuming that the rotor angular velocity is low enough 
so that no steps are lost during a move). Thus if a certain angular distance 
is specified, the motor can be commanded to rotate an appropriate number 
of steps, and the mechanical elements coupled to the shaft will move the 
required distance. 

2. The motor exhibits high torque at small angular velocities. This is, of course, 
useful in accelerating a payload up to speed. 

3. The motor exhibits a large holding torque with a dc excitation. Thus it has 
the property of being a “self-locking” device when the rotor is stationary. 
In fact, the rotor can move only when the terminal voltage changes with time. 


In addition to these characteristics, there are other advantages that often 
make designers of various pieces of equipment select the stepper motor over the 


dc servomotor: 


e The stepper is directly compatible with digital control techniques. Conse- 
quently, it can readily be interfaced with digital controllers and/or computers. 


e It exhibits excellent positioning accuracy, and even more important, errors 
are noncumulative. 

e Since open-loop control can be employed with 
essary to use a tachometer and/or an encoder. 


erably. 
© Motor construction is simple and rugged. There are usually only two bear- 


ings, and the motor generally has a long, maintenance-free life. For this 


reason it is a cost-effective actuator. 
e The stepper can be stalled without causing damage (du 


the motor, it is often unnec- 
Thus cost is reduced consid- 


e to overheating). 


e stepper motor potentially useful in certain 


uld be the relatively low cost with respect to 
that makes it an extremely 


Several of these traits make th 
types of robots. An obvious one wo 
the de servomotor. A second property of the stepper 


ees 
_*We will shortly see that this “full-step 
technique called ‘‘microstepping.” 


> value can be significantly reduced by employing a 
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hap ‘ 
attractive choice in the actuation of a robot joint is its dc holding ch 
The reason for this is that a common failure mode for the Power ampli “lerigti, 
used to drive a motor is for an output transistor to short from collecto, ; ler that x 
The result of this is to apply the full dc voltage to the motor ismen, “Mitte, 
servomotor is being used, the joint will ‘‘run away” until an obstacle Or i re, ‘ 
limit stop is encountered. In either case, an extreme] “Chan 


y dangerous Situatio. “al 
result. However, if a stepper motor is being used, the application of full N will 
Su 


voltage will cause the motor fo move one step and hold. Thus no runaway cong: 
will exist, and the stepper is seen to be safer under this type of failure. Ndition 

Although safety and cost are two factors that make the Ste 
alternative, the open-loop-control feature, which contributes to its cost adva 
over the servomotor, may actually turn out to be a disadvantage. The reas 
this is that since there is no position or velocity feedback, the joi 
master processor does not know whether the manipulator is actual 
example, if the manipulator encounters an unforeseen obstacle j 
during a move (e.g., another machine tool that is being used in 
Station), the controller will nevertheless continue to Output the ca 
of pulses required to cause a specific arm motion. When all these 
it will “‘think”’ that the desired position has been reached and hence no more pulses 
will be produced. However, the arm may actually be stalled somewhere else jn 
the workspace. Thus large position errors can result. 

It is possible to prevent this type of error from occurring by utilizing some 
type of position sensor. A simple, inexpensive device can often be employed for 
this purpose since it is not actually used in the control process but is present only 
to inform the controller that the manipulator is actually moving. However, an 
intermittent and/or momentary type of stall (e.g., one caused by increased bearing 
friction due to wear) will not be helped by such a sensor. In this case a “good” 
position and/or velocity detector would be required. As a consequence, some of 
the stepper’s cost advantage would disappear. (The Merlin robot, in fact, utilizes 
position sensors to ‘‘close the loop.’’) 

Position errors can also be caused when one attempts to move the rotor too 
rapidly. In this instance the motor cannot respond fast enough to the pulses — 
from the controller so that each pulse does not produce an actual step in the — 
position. This phenomenon of “dropped steps”’ will cause the robot arm to i 
a final position that is in error. The ‘fix’ in this case is to reduce the ng | 
rotor velocity and/or the load (i.e., the inertia reflected back to the motor S 
Clearly, such a compromise causes a degradation in performance. 

Another potential difficulty with a stepper motor in a robot app! 


Pper an attractive 


Ntage 


On for 
nt controller o, 


ly moving. fo, 
nN its workspace 
the same work. 
Iculated numbe; 
have been Sent, 


ication 's 


| . Place , ‘lation. since "° 
that the stepwise motion can excite significant manipulator oscillation. employ 4 
velocity feedback is used, the only way to improve the response is to low): 


ined bele 
much more elaborate controller that is capable of microstepping —. oding the 
This increases the cost of the drive electronics significantly, further it ig unlor 
cost differentia] between the stepper and servomotor. At this writing 
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ec. 4.0 
runately true that the potential problems in using the stepper motor as a robotic 
actuating device outweigh the advantages. However, this may change in the future. 


4.6.1 principles of Stepper Motor Operation 


e are two basic varieties of stepper motors that can be constructed: (1) the 


Ther 
variable reluctance (VR) type, and (2) the permanent magnet (PM) type. Al- 
shough the PM style is most often used in a broad range of applications today, the 


operation of the VR stepper is easier to understand and therefore we consider its 
operation In this section. 

The structure of a typical VR stepper motor is shown in Figure 4.6.1. It iS 
observed that unlike the servomotor, both the stator and the rotor are toothed 
structures. Fundamental to the operation of this motor is that the rotor and stator 
do not have the same number of teeth. For example, the stator shown in Figure 
46.1 has eight (located every 45°) and the rotor has six (located every 60°). In 
addition, each stator tooth has a coil wound on it with oppositely placed coils (e.g., 
A and A') being grouped together and referred to as a phase. In this example it 
‘; seen that there are four phases (labeled A, B, C, and D). 

The operation of the VR stepper is quite simple, being based on the principle 
of “minimum reluctance” whereby a magnetic structure always attempts to reorient 
‘tself so as to minimize the length of any air gap in the magnetic path. One can 
think of the magnetic device moving so that the magnetic field can find the path 
of “least resistance.”” Thus for the example shown in Figure 4.6.1, when phase 
Ais energized, rotor teeth 1 and 4 (R4,1) will align with stator teeth 1 and 5 (S5,1) 
and will remain in this position as long as the coils in the same phase are energized. 
This is said to be a stable equilibrium point and represents “one step’’ of the motor. 

It is important to understand that as long as the excitation remains on coils 
A-A' there is a holding torque, so that if any applied external torque is less than 


Figure 4.6.1. Basic structure of a vari- 
able reluctance-type stepper motor (Re- 
drawn with permission of the Superior 
Electric Co., Bristol, CT.) 
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; ; ; ; AD, 4 
this value, no motion will occur. Also, increasing the current throy 
will not cause the rotor to move but will, in actuality, increase this holdj is Pha 
Thus the motor will tend to “‘lock”” more under increased current Py, Orgy 
should be compared to the servomotor, where increasing the excitatic oe hi 
to make the rotor turn faster. On will teng 

Now suppose that the excitation is removed from phase 4 ang 
phase B. R6,3 will align with S8,4 as shown in Figure 4.6.2a. It can b Placeg 0 
the rotor has moved clockwise through an angle of 15° (60 ~— 45 ~ Ph thay 
process can be repeated for phases C, D, and then back to A (see Figures, his 
c, and d). In each case, a 15° step occurs with a complete sequence ap oth, 
excitations (e.g., A, B, C, D, A), producing a rotation of 60°. Conse que Phase 
this example, it requires six such cycles to cause one complete rotor eae In 
and we would therefore describe this as a “‘24-step/revolution”’ motor. ution, 

The reader may easily verify that making the phase excitation sequence 
D, C, B, A will produce counterclockwise rotation of 60°. This sequence ie 
is quite easy to implement in practice. It can be demonstrated, in genera] fia 
change of direction requires at /east three phases. 

The step angle is related to both the number of stator teeth N, and roto, 
teeth N,. Specifically, it can be shown that 

IN, Za N,] 


step angle = 360 NN, (4.6.1) 


and that the 
number steps/rev = mee (4.6.2) 
» 7 IN, _ N,] - 


Physically, rotors of all stepper motors exhibit an underdamped response in 
moving from one step to another (e.g., see Figure 4.2.4). This can most easily 
be seen by recognizing that when the excitation 1s changed to an adjacent phase, 
the rotor travels toward the new equilibrium point. Although the accelerating 
torque is zero when the rotor and stator teeth are in alignment, the angular velocity 
of the rotor is not zero. As a result, an overshoot of the equilibrium position 
occurs. There will now be a torque on the rotor that will accelerate it back — 
the equilibrium point that was just passed (i.e., in the opposite direction). In a 
this process may actually be repeated several times before the rotor comes t0 : is 
In general, the magnitude and duration of the damped oscillation 1s doperien i 
the step angle (i.e., the larger the angle, the larger the overshoot). In are a 
applications, such behavior may not be acceptable (e..g, a robot), whereas 1" 
it will be perfectly all right (e.g., a printer). 

Stepper motors can be made with a wide range of steps/rev- ie of 1-8" 
standpoint of cost, a practical upper limit is 200 and produces a step ane™ oto! 
For many applications, this relatively small angle is quite adequate (¢-8-» e fine! 
oscillation will not interfere with the device operation). However! pins angulal 
step-angle resolution is required (note that this is one way tO reduce 
overshoot problem described above), other techniques can be used. 


he 
From 
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Phase C Energized 
(b) 






60°=1 rotor tooth 





Phase A Energized 


Phase D Energized 
(d) 


(c) 


Figure 4.6.2. VR stepper motor excited in the sequence BCDA. The motor is 
assumed to start in the position shown in Fig. 4.6.1. (Redrawn with permission 
of the Superior Electric Co., Bristol, CT.) 


4.6.2 Half-Step-Mode Operation 


In the previous discussion, one phase was energized at a time and produced a step 
angle given by Eq. (4.6.1). This method of operation is called full-step mode. 
Now suppose that two adjacent phases (€.g., A and B) are energized simultaneously. 
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It is logical that an equilibrium point is created somewhere between 
step points (as determined by separately exciting phases A and B) : 
electrical properties of the coils in the two phases are identical] -" - fact, if rs 
excitation amplitude is applied to both sets of coils, the new equilibriny If the Same 
be about halfway between the full-step points. This process can be mn Point y, 
phases BC, CD, and DA so that additional “halfway” equilibria cap “Teated OF 
tained. It should now be clear to the reader that if the phase excitation SO be op, 
is A, AB, B, BC, C, CD, D, DA, A, and so on, the rotor will make 4.10" 
number of clockwise moves as before (i.e., with respect to the full-ste WICE€ the 
and thus the stepper in Figure 4.6.1 will now have 48 discrete equilibriy 
per revolution. The name given to such an operation is, not surprisin 
step mode. Since the rotation angle per step has been cut (approximate] 
the angular overshoot of the rotor in moving from point to point is red 
Reversing the phase excitation sequence will cause the rotor to turn in the et 
terclockwise direction, as before. The switching circuitry needed to produce ne 
step operation is somewhat more complicated and is therefore more costly than 
the relatively simple full-step electronics. 


©), 
m Oj ts 
gly, half. 
Y) in half 


4.6.3 Microstep Mode 


A little thought should convince the reader that there is nothing “sacred” about 
exciting two adjacent phases equally (e.g., both with V volts). In fact, it is possible 
to use an excitation voltage anywhere between 0 and V in order to energize the 
second phase. In this case the stable point will occur at some location (but not 
halfway) between the two full-step equilibria. This scheme produces a mode of 
operation generally referred to as microstepping. Most often, the microstep size 
is determined by dividing the angular distance of a full step by an integral power 
of 2 (e.g., 2, 4, 8, 16, or 32; this produces the smallest computational burden on 
the stepper motor controller). Although microstepping requires considerably more 
complex switching circuitry to implement so that the cost is quite a bit higher ~ 
that required for full-step operation, its use generally produces smoother ae 
operation of the motor. Ina robot application, this is an important consideratlo 

since oscillation at the desired final point is usually unacceptable. 


4.6.4 Additional Methods of Damping Rotor Oscillations 
; ne 

There are other ways to damp out the rotor oscillation described in Section te by 
for example, by adding a viscous inertia (often called a Lanchester Ca chnique 
using either a friction disk or eddy-current damper. Although these sely 2 ect 
achieve the desired goal, they also add inertia and may therefore neem -nertid 
the transient response of the rotary system (this will not be true if the sys 
is already high). 

An electronic technique exists that avoids the problem creat ; 
inertia. Called bang-bang damping, the idea is to accelerate the ™ 


added 
ed és ‘nthe 
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1 way. However, before the rotor reaches its desired position, the phase 
‘on sequence IS T eversed, causing the rotor to decelerate more ra idly If 
eversal Is timed correctly, the rotor can be made to come to oa the 
; ilibrium point with almost no overshoot. Clearly, the timing of the reversal is 
cal and, it turns out, the switching instants are a function of system parameters 
6. friction and load inertia). In a robot, where the inertia of an int usuall 
‘eS significantly with position (and hence with time during any chasms a -_ 
sophisticated scheme ‘'s required to sense these changes and then modify the phase 


rsal times accordingly. 


crit! 


reve 


4.6.5 Permanent-Magnet Stepper Motors 

As stated previously, the PM stepper motor is the most comonly used type. It 
consists of a multiphased stator and a two-part, permanent-magnet rotor. Just as 
with the VR stepper, both of these structures are also toothed (see Figure 4.6.3). 
The major difference in this case is that the opposite ends of the rotor are north 
and south poles of a permanent magnet with the teeth at these ends being offset 
by half a tooth pitch. Although the operation of this type of motor will not be 
discussed any further, it is. worthy of mention that the PM stepper can be operated 
in full, half, or microstep mode. Table 4.6.1 indicates the major differences be- 


tween the two classes of steppers. 


4.6.6 Stepper Motor Drives 


position is dependent on the 
bipolar signal 1s required to 
4.6.3, it is seen that this 


As indicated in Table 4.6.1, the PM stepper rotor 
polarity of the phase excitation. Consequently, a 
achieve bidirectional control. With respect to Figure 





Permanent 
Magnet 
_! ——] ~~ UU 
ad == 
Rotor 
A-A’—Phase A A-A’—Phase A 
B-B’— Phase B B-B’—Phase B 
Stator with Stator with 
rotor section N 


rotor section S 
per motor. (Redrawn with 


Figure 4.6.3. A simplified diagram of a permanent-magnet step 
Permission of the Superior Electric Co., Bristol, CT.) 
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G 
TABLE 4.6.1 DIFFERENCES BETWEEN PM AND VR STEppep Na 4 
MOTORS 
1. Motor Magnetized Not magnetizeg 
2. Rotor position Depends on stator Independent of 
excitation polarity stator excitatio 
polarity " 
3. Rotor inertia High due to magnet Low (no magnet) 
4. Mechanical Not as good (due to Good (low-inertia 
response high inertia) device) 
5. Inductance Low due to rotor offset Generally high 
for same torque 
rating 
6. Electrical Faster current rise (due Slower current 
response to low inductance) rise (due to 
higher 
inductance) 


eS 


operation is accomplished with only two phases, whereas the reader will recall tha 
the equivalent VR stepper required four phases (see Figure 4.6.1). 

Using a double-ended power supply, the motor in Figure 4.6.3 can be driver 
in the full-step mode with the switching arrangement shown in Figure 4.6.4a. | 
is observed that two fristate switches, SW1 and SW2, are required. This figur 
shows phase A positively energized and phase B off. A possible method of syn 
thesizing such a device is shown in Figure 4.6.4b. The “‘fly-back’’ diodes ar 
normally used to protect the power transistors from the “‘inductive kick’’ that occur 
when an open circuit is suddenly placed in series with an energized inductor (¢.g. 
Q, is switched off). Without this protection, it is possible to apply a voltage well 
in excess of the transistor’s collector—emitter breakdown value during the switching 
interval. 

For the motor in Figure 4.6.3, it can be shown that each step is 18° and 
there are therefore 20 steps/rev (see Problem 4.22). The excitations and oe, 
logic signals to the transistors that produce four rotor steps (1.€., 72°) nea " 

; , e imply! b 
Figure 4.6.5. It is assumed that each step takes the same amount of tim puring 
that any load attached to the rotor is moving at a constant velocity. ey with 
acceleration or deceleration of a load, the step spacing would, of course; vary 
time. ‘ne the 

In actual operation, a microprocessor (e.g., the master) would — This 
number of steps needed to cause a load to be moved a certain distar’ id thet 
would be done for each joint in a robot application. The processor oa discret 
transmit the information, together with direction and step timing data, numbe! o 
digital hardware package. The latter would keep track of the tota ‘ Cleat!) 
steps moved and would implement the appropriate switching sequen” . -Ret# 
this would represent open-loop joint control, with its inherent pro 
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POssib ie mplified bipolar two- 
ible realization of the cause in hie aa switch stepper motor drive; (b) 
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(c) 
; otor 
Figure 4,6.5. (a) Transistor logic signals; (b) motor phase currents; (c) F 


motion for the motor in Fig. 4.6.3 and the drive in Fig. 4.6.4a. 
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sec. 46 
discussion In Section 4.6. Closed-loop control could also be implemented by 


eon one of the m ethods described in Section 4.5. As mentioned previously, 
Howevel’ this would negate some of the cost advantage of the stepper over the 


servomotor. 
Suppose that we wish to move a robot joint a total distance of m radians in 
400 ms using a Stepper motor. The joint ‘‘sees’’ a reflected load inertia J; 


= 0.004 oz-in.s*. (The load is coupled to the motor shaft through a 10:1 - 
gear train.) It is proposed to use a stepper with the following specifications: 


Ju = 0.003 oz-in.-s? 
step angle = 1.8° (200 steps/rev) 
rms torque = rated continuous torque = 7 oz-in. 
maximum step rate = slew rate = 4000 steps/s 


In addition, a triangular velocity profile is to be assumed (see Figure 4.6.6). 
Here ¢, and (t, — f,) are the acceleration and deceleration times, respectively, 
and are assumed to be equal in this case. The acceleration and distance 
curves resulting from this velocity are also shown in parts b and c of this 
figure and w,, and a,, are the peak angular velocity and peak angular ac- 
celeration of the motor shaft, respectively. The problem is to determine 
whether the given motor will be able to meet all the motion requirements for 
a joint move of this type. 

Because the load is coupled to the motor shaft through a 10:1 speed 
reducer, the motor must move 107 radians (i.e., 10 times the distance of the 
actual joint output). From Figure 4.6.6b and c, it is seen that 





l 
Wok 2 = 107 
and 
6d — “pk 
pk t 


Since t, = t,/2 = 200 ms, w,, and a,, needed to make this move are found 


to be 
Wp, = 50m = 157.1 rad/s 
i | 
Ak = D> = 785.5 rad/s? 


The corresponding peak acceleration and deceleration torques in this case 


renin een 
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geo: 4° 


are equal. a 


feos = J, + JM) Op. = 5.5 OZ-in. 


Since the acceleration curve ra Figure 4.6.6b is piecewise constant, the rms 
nd peak torques are equal.“ Consequently, it is seen that the proposed 
° ‘; adequate from a torque point of view. However, a single step is 


tor 1 
8: or 0.031416 rad. The resultant peak angular velocity is therefore 


137.4 


rk = Do31416 > 5000 steps/s 


Clearly, the speed requirement exceeds the maximum slew rate of the motor 
by 25%. In fact, it is probable that if we use it for the proposed application, 
steps will be dropped and accuracy will suffer. 

There are two things that can be done to meet the requirements of the 
problem. One involves using a motor that has the same torque rating but a 
higher slew rate. The other necessitates relaxing one of the specs. For 
example, suppose that it is permissible to make the move in slightly more 
than 400 ms. Then the trapezoidal velocity profile shown in Figure 4.6.7 
could be employed. Using this profile with ,, = 4000 steps/s and the 
acceleration and deceleration times still assumed to be equal, it is found that 

‘the acceleration torque is still 5.5 oz-in, 4, = 160 ms and the overall move 
time T = 410 ms (see Problem 4.23). Thus only a small time penalty results 
from using a constant-velocity segment of 90 ms during the move. 


4.6.7 Linear Stepper Motors 


An interesting variation of the conventional rotary stepper motor is the Sawyer- 
principle linear stepper motor. Invented in 1969, this patented device is manu- 
factured by Xynetics Corporation, Santa Clara, California, and consists of two 
major mechanical components. The first, a movable armature which is referred 
to as a forcer, is suspended over the second or fixed stator (also called a platen) 
(see Figure 4.6.8). A bearing is used to ensure that there is a constant space 
ig the armature and the stator. In contrast to a conventional rotary stepper 
ie has a closed geometry, the platen’s length is variable and depends on how 
differs fenne to move a load attached to the forcer. This configuration also 
and no om the rotary stepper in that the payload is directly driven by the motor 
mechanical advantage can be obtained through the use of a transmission. 

OM) amy be observed in Figure 4.6.8, the forcer consists of a permanent magnet 
two electromagnets (EM) with four poles (two per electromagnet). The 


t "No 
Orques of 


. that this is true only because we have assumed that both the viscous damping and friction 
es motor are zero. If either or both of these loss terms are not neglected, asymmetry in 
‘On and deceleration torque profiles will occur. 
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Permanent Magnet Air Inlet 
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Air Filler 
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Figure 4.6.8. Components of a two- 
a. re a" if phase linear stepper motor. An air 
bearing is formed between the bottom 
of the forcer and the top of the platen. 
(Redrawn with permission of General 


Platen Signal Corp., Santa Clara, CA.) 


the platen. This is accomplished by supplying air under pressure from tiny holes 
located in the forcer. The air bearing produces a surface with negligible starting 
and running friction. 

The permanent magnet causes the platen and the unenergized forcer to be 
drawn together (except for the space provided by the bearing). Therefore, it is 
possible to position the platen so that the forcer travels above or below it. With 
no current flowing, the PM flux closes its path through the air gap, platen, and 
the poles of the electromagnets. The flux splits equally at both EM poles since 
the magnetic paths have approximately the same reluctance (e.g., see Figure 4.6.9a, 
poles 3 and 4). If current is switched through the electromagnets, commutation 
occurs. In general, the flux produced by the permanent magnet is about equal to 
that produced in the magnetic circuit by the current flowing through the windings. 
Thus as the current changes, the flux swings from a maximum value to almost zero. 

The commutation, together with the relative positions of the forcer and platen 
teeth, causes forces to be produced which are perpendicular to the teeth and parallel 
to the platen. Since the teeth of the EMs are arranged in spatial quadrature from 
one pole face to the next, the PM’s flux can be commutated by the electromagnets 
and emerges at polefaces whose teeth are misaligned with respect to those of the 
platen. The result is a tangential force that causes the forcer and platen teeth to 
move in such a manner as to minimize the gap (i.e., reduce the reluctance). This 
lorce produces motion along the length of the platen. A normal force also exists 
Which pulls the forcer and platen toward one another, thereby providing the preload 

Or the air bearing. 
th Figure 4.6.9a—d is used to illustrate the principles of operation outlined in 
e ollowing Paragraphs. In each of the figures, the direction of current and flux 
's Indicated by the arrows. If electromagnet A (EMA) is energized, maximum 
R * density occurs at pole 2 and alignment is as shown in Figure 4.6.9a. When 
Pole .. deenergized and EMB is energized, the maximum flux density occurs at 
the al and the minimum density at pole 4. The attractive force at pole 3 causes 
Motion weet of this pole with the platen’s tooth on the right. Therefore, the 
‘S One-quarter of a tooth to the right and the motor and the forcer have 


OW 
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Figure 4.6.9. Motion in a rwo-phas® 
linear stepper motor. ach new P ‘ 
excitation produces 4 quarter P te he 
movement of the forcer relative f a 
platen. Thus a total motion ot ed 
full pitch is indicated. (REP wort 
with permission of General sign 
Corp., Santa Clara, CA.) 
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| relationship shown in Figure 4.6.9b. If EMB is deenergized and then 
ine SPU rgized (with a current flow opposite to that shown in Figure 4.6.9a), 
on end occurs to the right since pole 1 now has the maximum flux density, 
jon a6 minimum, while poles 3 and 4 have the flux supplied by the PM. The 
w resides at the location shown in Figure 4.6.9c. Finally, with EMA 
d and EMB energized (also in the opposite direction from before), pole 
aximum flux density, pole 3 the minimum, and poles 1 and 2 the flux 
lied by the PM. To complete the cycle, EMA is again energized as in Figure 
ee and the system has moved a distance of one tooth (i.e., the pitch) of the 
nn (the equivalent of full step mode in a rotary stepper). The frequency of the 
urrent cycling establishes the velocity with which the forcer moves. | | 
° Obviously, the positions of the forcer relative to the platen are discrete in 
nature if the current is cycled as described above. Used in this manner, the linear 
stepper has a full-step resolution defined by the spacing of the teeth on the poles. 
A typical pitch is 0.040 in. Thus for the sequence shown in Figure 4.6.9, the 
resolution is one-quarter of the pitch or 0.010 in. These positions are sometimes 
referred to as cardinal steps. To obtain a finer resolution between steps, it is 
possible to use current values that are between those used in the full-step mode. 
That is, the motor is operated in microstep mode (see Section 4.6.3). 

It is also possible to construct this type of motor so that it consists of two 
orthogonally oriented forcers assembled on one motor frame. To complement 
the forcer, the platen is constructed of square teeth in a waffle pattern, as shown 
in the two-axis linear stepper of Figure 4.6.10. This configuration allows motion 
in both the x and y directions or along any vector in the x-y plane. 

As indicated previously, the linear stepper is a direct-drive motor. This 
implies that the control resolution and force needed to position and move the load 
are defined solely by the motor’s capabilities. Thus for any application requiring 
resolution better than that of the tooth pitch, a controller capable of microstepping 
to the desired resolution must be used. Additionally, the speed—force curve for 
the motor—driver combination must be examined carefully to ensure that the motor 
“an produce the required forces over its operating speed range. 
cine The linear stepper exhibits the same resonance phenomena and loss of syn- 
ne (i.e. , loss of steps) as the rotary stepper. However, two characteristics 
“spring complicate the task of controlling this motor. First, the device ls inherently 
intervat Paps armature resides in a force detent that is the width of a tooth 
Setbacks th S the motor 1s subjected to inertial and drag forces, It experiences 
Necesca rat displace it from the center of the detent, thereby creating the thrust 
the detent © Overcome these external forces. If the setback reaches the limit of 
that ma on © motor will slip and lose synchronization. The second characteristic 
tesults fro control difficult is the highly resonant nature of the armature, which 
there is Ver It being supported on a frictionless surface (the air bearing). Thus 
Mass ry little damping of the spring—mass system formed by the armature 


and 33 
force detent function. Obviously, this condition makes the motor sus- 
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Figure 4.6.10. Two-axis linear stepper motor and platen. (Reproduced with 
permission of General Signal Corp., Santa Clara, CA.) 


ceptible to excitations near its natural resonance frequency. Consequently, it's 
slow to settle from unwanted perturbations that might occur during its motion. 

Figure 4.6.11 shows a plot of motor force versus displacement and is useful 
in explaining qualitatively the dynamic behavior of the linear stepper. In th’ 
figure it is assumed that the motor has been commanded to move to position P,a 
stable equilibrium point. Thus, in the steady state, no force will be exerted 0” 
the armature when it is at this location. If the armature is now moved to position 
A or B, it will be subjected to a restoring force that accelerates it back towal _ 
The farther away it is from P, the greater will be the restoring force until ae 
C or D is reached. These points are } of a tooth pitch (as defined by the aa 
of operation, i.e., full, half, or microstep) from the equilibrium. If the e i 
is moved still farther away from P toward U, or Uj, the restoring force Mi ide will 
the proper direction (i.e., toward the equilibrium point), but its magnitt 
decrease, F 

Points U; and U, are unstable equilibria and, as can be seen soe 
4.6.11, no force is exerted when the armature resides in these locations: c jerated 
if the motor is slightly displaced from either of these locations, !t will eer ched): 
away from them and continue to move (until a stable equilibrium point "al betwee” 
Thus, as long as the armature is not outside the (open) position intery 
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Figure 4.6.11. Motor force versus displacement for a linear stepper motor (3). 
(Redrawn with permission of J. Nordquist and P. Smit, Xynetics Products, a division 
of General Signal, Santa Clara, CA.) 


U, and Uj, it will remain captive about P. Note that just as in the case of a rotary 
device, the linear stepper is inherently underdamped, which causes the armature 
to oscillate about P before it finally comes to rest. In this regard, the reader 
should recall the discussion of Section 4.6.1. 

It should be clear from the above that the magnetic field configuration exerts 
force on the armature only when it is displaced from the commanded equilibrium 
position. Thus for the inertial and frictional forces to be overcome, the motor 
must actually lead or lag the commanded position. An examination of Figure 
4.6.11 reveals that the driving function must be such that the error between the 
desired and the actual armature positions is no more than i of a tooth pitch. If 
this difference is larger, synchronization may be lost. 

_ As the linear stepper is normally operated in an open-loop control configu- 
‘auion, it is important that the driving (forcing) function not excite the motor’s 
resonant frequency. For example, the microstepping rate must be carefully se- 
lected So that it is not at or near the stepper’s natural frequency. In addition, 
scillations in the motor can be induced even by seemingly smooth forcing functions. 
Se Nappens because the signal contains enough energy at the motor’s resonant 
er point to produce the ‘‘ringing.”’ Figure 4.6.12 shows the command and 

“ ee positions as a function of time for a triangular velocity profile. 
litieg eae in the figure is the error (i.e., the difference) between these quan- 
Lisim Particular note here is the appearance of oscillations in the error signal. 
A ome to understand that the ordinate represents the lag BOIWeen the actual 
Of the — positions, The reader should recall that this quantity is a measure 

Ce exerted by the magnetic structure on the armature. It can also be 
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Figure 4.6.12. Motor response and ef- 
ror for a triangular velocity profile and 
8.7 g’s initial acceleration with rollott 
(3). (Redrawn with permission ol J. 
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observed that when the lag reaches —20 mils, the armature is outside th 
position interval (U,, U,) and hence synchronization is lost. Clearly, with 
selection of the motor, load, and acceleration, it is possible to utilize a triang 
velocity profile without dropping steps. lineal 

A technique that has recently been developed for preventing ringing 1" ee 
steppers is called burst. A forcing function is defined which is based on mak! t) 
the difference between the command and actual armature positions (1.€., the rt 
a constant (lag) during the acceleration phase of the motion. Figure 4.6. inst 

nl 


a linear stepper driven in this manner. It is observed that there 1S 4! 1 
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difference of 5,2 mils. This is referred to as the ‘“‘burst.”” Note that with such a 
rcing function, the motor does not ring and there is no danger of dropping steps. 

°rmal implementation of the technique requires that the burst be applied at the 
breakpoints (i.e., at the beginning and end of acceleration and deceleration phases 
ithe motion). Further detail about the procedure may be found in the literature 


3}. 


F The speed—force curve for a typical linear motor is shown in Figure 4.6.14. 
ro 


M the curve it is apparent that while the speed of this motor can be quite high, 
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Figure 4.6.14. Force versus speed curve for a linear stepper motor. 


there is a corresponding decrease in available force in much the same way that the 
torque of a rotary device decreases as the angular velocity increases. One approach 
to utilizing such motors in a given application is to size them based on the force 
required at the maximum speed. This force must never be exceeded over the 
entire operating range of the motor. For example, referring to Figure 4.6.14, 
since the maximum force available at 50 in./s is 4.3 lb, then to ensure prope! 
operation, no more than 4.3 Ib of force should be used during acceleration nn 
deceleration. As can clearly be seen, this conservative approach does not ull 


the full capability of the motor. - Here. 
Another approach permits a given motor to be used more efficiealy. sail 
the velocity profile is piecewise linear (i.e., has multiple slopes) during pa safe 
eration and deceleration phases. This technique can reduce overall mo sions 
considerably. For example, if the acceleration phase is divided into pasate ding 
say 0 to 20 in./s, 20 to 40 in./s, and finally, 40 to 50 in./s, one can use yo a 
maximum forces of 7.53, 5.38, and 4,3 Ib, For a load of 16 Ib, this izing 
velocity profile shown in Figure 4.6.15. It is observed that by more 3 me DY ove! 
the capabilities of the motor, it is possible to reduce the acceleration 
25% (0.36 instead of 0.481 s). ¢ moto 
The attempt to better utilize the force capabilities of these 


rs is called 
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Figure 4.6.15. Acceleration portion of velocity profile for accelerating a 16-Ib. 
load to 50 in./s: (a) maximum force permitted is 4.3 Ib. (at 50 in./s); (b) piecewise- 
linear profile using forces of 7.53 Ib. in the range of 0 to 20 in./s, 5.38 Ib. in the 
range of 20 to 40 in./s, and 4.3 Ib. from 40 to 50 in./s. 


acceleration roll-off. Its implementation may take the form discussed above or an 
exponential acceleration waveform can be used. In either case, the basic idea is 
to adjust the acceleration and deceleration during any move, utilizing the force 
velocity curve of the motor, so that the sum of the inertial and drag forces is 
maintained at a constant value. It is important to understand that this technique 
does not prevent characteristic ringing associated with all steppers. As mentioned 
above, this must be handled by carefully selecting the forcing function. Anexample 
of a motor that uses both acceleration roll-off and burst is shown in Figure 4.6.13. 
Some of the major advantages of linear stepper motors are their ruggedness, 
high reliability, and simplicity, all due to the low component count needed to 
implement these devices. Additionally, they have the ability to achieve extremely 
good accuracy and repeatability while moving loads at very high speeds and over 
large distances without the use of transmissions. Also, the air bearing that is a 
major part of the linear stepper is virtually free from wear so that the motor 
generally requires little or no maintenance. 
The use of this type of motor to implement a linear drive stage results in a 
Cost that is typically in the top end of the price range for conventional implemen- 
lation (i.e., a stage made up of a lead screw, sliders, dc servomotor, and feedback 
Clements), Other disadvantages besides cost are the complexity of the drive elec- 
Tonics needed to reduce ringing, achieve microstepping, and produce the high 
Pulse rates, and the reduction in force that occurs with increased velocity. 
-_ this writing, no commercial industrial robots a Pompe stepper 
a the, However, as cost is reduced, it is expected that direct-Crive capadlitties 
__ -e 4ctuators may well make them attractive in applications requiring the high 


reliahi; 
liability that results from minimum component count. 
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4.7 BRUSHLESS DC MOTORS 


In electrically actuated robots, brush failures in the dc Serv 
joints account for a major source of downtime. These dev; 
effective terminal resistance of the armature to increase Sig 
ducing the efficiency of the servo. Increased heating and 
two of the major consequences. In addition, as the motor 
the brushes and commutator segments occurs due to the s 
current in the particular armature coil being commutated.* 
to mechanical deterioration of the brushes themselves, whic 
in “clean room” applications (e.g., in the handling of semicond 
also prevents robots so actuated from being used in explosiv 
nally, the electromagnetic interference (EMI) produced by t 
also create reliability problems for other electronic devices 
of the robot. 

In recent years, dc motors have been developed which avoid Many of the 
difficulties attributable to the brushes of a standard servomotor. As shown in 
Figure 4.7.1, the brushless dc motor (BDCM) can be viewed as an “inside-out” 
version of a standard dc servomotor.} It is observed that the rotor of the brushless 
device contains the permanent magnets (two in this case, thereby producing a four- 
pole motor) whereas the stator consists of the coil segments and iron. 

Since there is no mechanical commutation of the coils in a BDCM due to the 
elimination of the brushes and commutator bars, a method of properly energizing 
the stator coil segments must be provided. This is often accomplished by placing 
inside the motor itself solid-state devices (e.g., Hall effect bipolar sensors) that 
determine the actual position of the magnets as the rotor turns. A simple logic 
circuit then processes the information provided by these sensors, thus — 
appropriate stator coil to be excited. As an example, consider the ale 
north and four south), three-phase winding BDCM and the electronic ore oa 
scheme shown in Figure 4.7.2. The output of a Hall effect sensor 1s — ae 
1) when the south pole of a permanent magnet is in close img “ . ~ nso 
Output is low (logical 0) if the magnet’s north pole is passing by. Wit jets 90 Me 
placed approximately 120 mechanical degrees apart and the four Oe eae that 
chanical degrees apart as indicated in Figure 4.7.2, it is easily — 7.3, The 
the outputs of the three sensors are the waveforms shown 1n a osition of the 
signals can be processed by a simple logic circuit to eeoinagge ie the drive? 
magnets at any instant of time. This information is then a | 
circuit to cause the appropriate motor windings to be energize tant with respe 

Ideally, it is possible to produce a torque output that 1s con 


CES Wear, cay: the 


igs > ds) 
nificantly , theret” the 
torque reduction a 


turns, arcing betwe 
udden Interruption in 

Besides contributin 
h can limit their 
uctors), this Situation 
© environments, fF; 
he electrical Spark cap 
working in the Vicinity 


to 32) 


q 
ts (€-8° 
as en 8 segmen 
“For this reason, most servomotors divide the armature coil into 2 iat 
so as to reduce the inductance and hence the “‘kick’’ produced during — st common form. 
+Although this is not the only design for such a device, it is the mo 
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Wound Rotor Design 
(Brush Type) 
(a) 


Wound Stator Design 
(Brushless Type) 
(b) 


Figure 4.7.1. Cross sections of two servomotors: (a) standard DC (brush-type); (b) brushless 
DC-type. (Redrawn with permission of Electro-Craft Corp., Hopkins, MN.) 


to angular position. To see this, consider the three-phase driver circuit shown in 
Figure 4.7.4 and assume that the BDCM windings are arranged in a wye config- 
uration. If a constant current is applied to each winding and the rotor is moving 
at a constant angular velocity, the torque produced by each of the phases as a 
function of the angular position of the motor shaft @ is shown in Figure 4.7.5. It 
is important to understand that the total or net torque Ten produced by the motor 


is the algebraic sum of the three torques 7,_,, T,_., and ‘ Clearly, if we 


permit a constant current to flow in each of the three phases, T,.,, will not be 
constant as is desired. 

_ However, suppose that the information from the Hall effect sensors’ output 
(Figure 4.7.3) is used by the logic circuit to produce the transistor base drive signal 
‘quence indicated in Figure 4.7.6. Also assume for the moment that despite the 
Presence of an inductance, a constant current J immediately flows through each 
Tansistor in the three-phase bridge circuit when the corresponding base signal 
"MPs to logical 1 and that the collector current instantaneously drops to zero when 
Oe TIVE signal is logical 0. Then it is easy to understand why Tyen will be inde- 
thar of angular position. For example, from 0 to 60°, Figure 4.7.6 indicates 
during ye s are conducting so that only coils A and B es oy ay yr 
and g 'S Spatial interval, Fen = Tax Since the torque produced by coils A— ; 

~~ WS Zero (the current in these coil pairs is zero). During the next 60 
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Figure 4.7.2. Eight-pole, three-phase winding brushless DC motor with electronic 
commutation scheme utilizing three Hall effect sensors. (Redrawn with permission 
of Micro Switch, a Honeywell Division, Freeport, IL.) 


period, Q, and Q, conduct and so only coil pair A—C is energized. Thus 7,,, 1s 
still T.,.,- It is easy to extend this analysis to other 60° intervals. 

The reader should understand that because the three-phase bridge circuit 1s 
driving inductive loads (i.e., the stator coils), the phase currents cannot instanta- 
neously change when the transistors are rapidly turned on or off by the digital 
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Figure 4.7.3. Outputs of three Hall effect sensors used in the 8-pole, 
BDCM of Fig. 4.7.2, (Redrawn with permission of Micro Switch, a Fone 
Division, Freeport, IL.) 
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Figure 4.7.4. Three-phase driver circuit for th 
e BDCM with . . 
stator. (Redrawn with permission of Electro-Craft Corp. Hopkins — 


signals from the logic circuit. Instead, these currents exponentially ri fall i 
time (and hence angular position), which causes 7,., to vary some h t with ra 7 
there will be some torque ripple). ~ bd ee 
As mentioned in Section 4.6.6, it is important to include “‘flyback’’ diod 
whenever an inductive load is rapidly switched in order to eae is l a 
lector-to-emitter voltage produced by the ‘inductive kick”? occurring at mi vor 
from destroying the power transistor. This is the purpose of the diodes daa 
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gure 4.7.5. Torque versus motor shaft angle 
mission of Electro-Cratt 
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eal in each of the three phases. (Redrawn with per 
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0=Q Off 
Figure 4.7.6. Transistor base drive (logic) signals for the three-phase driver circuit 
shown in Fig. 4.7.4. (Redrawn with permission of Electro-Craft Corp., Hopkins, 


MN.) 


Figure 4.7.4. If fast recovery diodes are utilized for this purpose (e.g., Schotky 
devices), the fall time of the phase currents is very rapid and the torque ripple 
described above is reduced somewhat (see Problem 4.31). 

Despite its obvious advantages over standard servomotors, currently few if 
any commercial robots utilize brushless dc motor technology. The primary reasons 
for this are the added cost of the driver circuitry and the lack of familiarity with 
the procedures needed to make the motor operate properly. However, it Is ex- 
pected that as the demand for higher-performance manipulators increases, the cost 
of the electronics will fall and more manufacturers will employ BDCMs in the 
subsequent generation of industrial robots. 


4.8 DIRECT-DRIVE ACTUATOR 
One of the major problems with commercial robots is that at certain speeds (usual 

but now always low), mechanical resonances are excited and exceedingly 4 
motion results (a so-called ‘“‘palsy” is exhibited). Although some of the nee 
can be traced to the structure of the manipulator itself, it has been found we the 
of the primary causes of poor motion is the mechanical devices used to wate . e 
motion of the actuator to the output of each joint mechanism. For! examP ; : 
harmonic drive, which is currently used extensively for this purpos¢> ts col 
significantly to the low-speed performance degradation due, in part, ae in the 
pliance (i.e., “‘springiness”’) and also to machining errors which are inheren let 
design and cannot be entirely eliminated. (See Section 3.3.1.2 for amor 
discussion of this component.) desil4 

A design that does not employ such mechanical units is obviously refer 


(i.e., a direct connection between actuator and load is indicated; this '° 
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9 as 2 jrect-drive spproe). Fe hemlet despite the acknowledged difficulties 
ith coupling devices such as tle armonic drive, they are still utilized extensively 
sl manipulators: The justification for this is that “torque multiplication” and 
in d position resolution that such components afford are absolutely critical in 
cessful design of robots. Without these attributes, motors would have to 
Ke extremel large, bulky, and quite costly since they normally produce maximum 
speeds too high to be of any use in a direct-coupled application (e.g. 

nds instead of tens of rpm). In addition, it would be necessary to employ 
h resolution encoders that also would be costly (this is, in fact, one of the 
guments against a direct-drive design). 

In the early 1980s, however, a new motor was developed which does permit 
4 practical direct-drive robot to be constructed. This novel actuator, manufactured 
by Motornetics Corporation and called a Megatorque motor, produces extremely 
large torques (e.g., 35 to 1000 ft-lb) at low angular velocities (e.g., 30 rpm) without 
the need for a speed reducer. In addition, a position-sensing element that is an 
integral part of the motor has been developed and permits the resolution of a robot 
hased on such a motor to be at least as good as those manipulators that currently 
utilize more traditional sensors (e.g., optical encoders). 
In effect, the Megatorque motor is a three-phase synchronous device that is 


rated as a brushless dc actuator, i.e., electronic commutation is employed. 


ussed in the preceding section, however, this one is a 
does not contain a permanent magnet 
s a series of laminations that combine 


thous 
very hg 
primar y ar 


ope 
Unlike the BDCM disc 
yariable-reluctance device and consequently 


(see Figure 4.8.1). The heart of the motor 1 
the rotor and stator. One such lamination is shown in Figure 4.8.2. Itis observed 


from this figure that there is a thin annular rotor mounted between two concentric 
stators. Both stators react with the rotor, thereby producing a significant torque 
multiplication (over a single stator design). The large number of magnetic teeth 
located on the rotor and the two stators is also instrumental in large torque pro- 


duction. 
The three-phase magnetic field is 
of the two stators). There are 150 teet 


produced by 36 stator windings (18 on each 
h on each of the stators and the rotor which 


perform as motor poles in this design. Torque is produced by sequentially en- 


ergizing these poles. For a single rotor revolution, there are 150 ac cycles, which, 
duction with the corresponding torque multiphi- 
ut the toothed rotor/stator combination, 


300 poles per phase or 900 windings in 


in effect, creates a 150:1 gear re 
Cation.* It is interesting to note that witho 
wae conventional motor would require 
Ito yield the same performance! 
Another advantage of the sandwic 
t the magnetic flux travels over an 


Pe 

“It j increase the generated 

It is w . f poles of a motor tends to in 

t ell known t asing the number 0! P 

orque While reducing oe oe he output power is unaffected, so this — is a 

«i orig an ideal gear train (or other speed reducer), that 1s, one with a 100% efficiency, on the 
°F's output shaft. 


rotor between the two stators 


hing of the 0 sti 
hort path, as shown 1n Figure 
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Figure 4.8.1. Cross section of a Motornetics, Inc. ‘‘Megator -< Corp’ 
ornetics 


motor. (Reproduced with permission of B. Powell and the Mot 
subsidiary of NSK, Santa Rosa, CA.) 
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Figure 4.8.2. A quarter section of the laminations of a toothed megatorque motor 
showing two stators sandwiched around'a toothed rotor. (Reproduced with per- 


mission of B. Powell and the Motornetics Corp., a subsidiary of NSK, Santa Rosa, 
CA.) 


4.8.3. It is observed that the flux from one stator passes radially through the thin 
‘Otor into the other stator. (This is to be compared with the more conventional 
Motor design, where a flux path of 180° through the rotor is typical.) Such a 
“onfiguration lowers the magnetic resistance, and 1 the motor has a high 
""que-to-input power ratio (high flux per ampere-turn). 

Unlike the more conventional Fela. sore the rotor of the Megatorque 
Motor does not carry any current. As a consequence, there is little heating of the 
'Otating member and therefore heat dissipation problems are minimized. This 1S 
a Particularly important attribute in robot applications, where the actuator Is often 
*Perated in a stall condition [e.g., when a load is being held {against gravity) in 
Any heat that is produced (in the stators) is a oe _ eat 
“case. In addition to essentially removing the temperature limitations whic 
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Figure 4.8.3. Flux Path for 
torque motor laminations. 
portion (the rotor) moves With respec 
to the outer and inner laminations (sta- 
tors 1 and _2). (Reproduced with per- 
mission of B. Powell and the Motornet. 


ics Corp. a subsidiary of NSK, Santa 
Rotor Rosa, CA.) 
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are associated with other motors, the direct-drive device does not have the de- 
magnetization problems associated with many of these actuators. Thus there is 
no danger of causing a permanent degradation of the motor’s electrical performance 
due to a large (and perhaps inadvertent) current spike.* All that happens in the 
Megatorque unit is that the iron laminations are driven into saturation, a situation 
that is completely reversible by reducing the flux (current excitation). 

When combined with an integral position-sensing element also developed by 
Motornetics (see Section 5.2.4 for a discussion of this resolver-like device), 4 
successful direct-drive robot is feasible. It is important to understand, howevel, 
that not every robotic configuration can utilize this new actuator technology. The 
primary reason is that the Megatorque motor is extremely heavy, and thus tt a 
be incorporated into a manipulator that does not require the actuator to be oii 
by the particular axis. One such design is the SCARA-type robot (see — 
1.3.2.3) where the two major axis motors can be placed so that their weights " 
supported by the manipulator structure rather than by a motor-produced ae 
The first commercial direct-drive robot was demonstrated at the Robots 8 “dep 
ence held in Detroit in June 1984 by the Adept Corporation. Called the 


; | hows 
I, this SCARA class manipulator incorporates two Megatorque motors and ® 
impressive low- and high-speed performance. 
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In describing 4 direct-drive approach to robotic actuation, we have limited 

discussion to the Megatorque motor since this is the only commercial device 

e atly applicable to robotics. It Should be mentioned, however, that at this 

curt © research efforts at both MIT and Carnegie—Mellon University are under- 

—, is certainly possible that in the future, additional commercial direct-drive 


wale designs will emerge and that more robots will utilize this potentially attractive 


technique. 
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When a robot is required to move sizable loads (e.g., greater than 10 Ib) in a rapid 
and precisely controlled manner, the use of a servomotor as the actuator may 
become impractical because of its high cost, weight, and volume. In this case a 
hydraulic actuating device is most often employed, the decision being based on a 
rule of thumb which states that “‘for actuators of greater than 5 to 7 horsepower, 
hydraulics should be considered.” (It should be pointed out, however, that at this 
writing, new design and manufacturing techniques are making the use of servo- 
motors more feasible in large robots.) These types of devices produce high po- 
sitional stiffness, deliver large forces, and can be designed so that they are over- 
damped. Moreover, such features can all be incorporated into a fairly compact 
physical package. We now consider the behavior of such actuators. 

The heart of a hydraulic actuator is the servovalve (also called a pilot valve), 
a device having the characteristic of producing an oil flow that is proportional to 
the current supplied by a servo amplifier. This oil flow, in turn, causes a cylinder/ 
piston arrangement (sometimes called ‘“‘the actuator” or “hydraulic motor’) to 
move producing either linear or rotary displacement. Thus any load coupled to 
the piston shaft will be moved in the same manner. 

The schematic of a two-stage flow control servovalve (of the deflector jet 
type) is shown in Figure 4.9.1. Here P represents a (constant) supply pressure 
and R is the return or drain. The tubes C, and C, at the bottom of the figure are 
ae control ports and are attached to the cylinder/piston as shown in Figure 
(c 2, Ps should be noted that other types of flow control configurations exist 
= Ouble nozzle and jet pipe valves). However, their behavior is essentially 

‘me as the deflector jet valve, so they will not be discussed here. 

Valve — consider the operation of the second stage of the deflector jet servo- 
. tight — Valve spool is moved to the right, the high-pressure supply port on 
9.2a) ena to control port C3, causing it to become an outlet (see Figure 

connected 3 also seen that the left-hand supply port is closed off and that Q is 
9.29 aaak the drain, making it act as an inlet port to the ek Figure 

Will be p aa that with the situation above, the pressure on one ra of the re 

© piston gh “? the other side, P,. Since P > P,, the mass M that 1s coupled to 

ite alt will move to the left. . . . 

§ the spool to the left will reverse the actions described above. In this 
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From 
Servovalve 


C, C, 





Cylinder Mass 
(a) 
From 
Servovalve 
C, on 
P, P 
Figure 4.9.2. Hydraulic cylinder piston 
arrangement: (a) valve spool (in the 
servovalve) moves right. P > P, which 
causes mass M to move left; (b) valve 
spool moves left. P, > P and M move 
(b) to the right. 


“ase, Figure 4.9.2b indicate 


- s that the larger pressure (P,) will be on the left side 


Piston, So that the mass will move to the right. 
torque rig Stage of the servovalve consists of a small dc permanent-magnet 
to produc Or and a deflector jet hydraulic amplifier. These components are used 
Motor eas hen valve spool motion. The armature, coil, and pole pieces of the 
OWs in the Own in Figure 4.9.1 together with the fluidic amplifier. When current 
Plane of i cou, the armature rotates either clockwise or counterclockwise (in the 
Onnectg ne Paper), causing the flexure tube to move the deflector. This action 
‘POOl ang © supply pressure to either the right- or left-hand far surface of the 
results in a difference in pressure between these two surfaces, thus 
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producing linear motion of the entire spool assembly. Reversing the a; 
the current will result in the opposite motion of the spool. Extreme, 0 of 
rents, on the order of tens of milliamperes, are needed to produce this smal Cur. 
cause the load and supply pressures to be equal. Smaller currents “aon and 
lower load pressures. It is interesting to note that recently, stepper mot Produce 
been used in place of the torque motor. OTS have 

The deflector jet servovalve shown in Figure 4.9.1 uses a cantilevereg «.- 
to monitor the position of the spool. This information is “fed back” tin 
and is used to produce a load torque on the flexure tube. Thus a Pg 
equilibrium of the spool is achieved for this scheme. This can be most easily se : 
by noting that for a given input current, the motor armature, and hence the ‘ecal 
continues to move until the countertorque produced by the spring balances the 
torque developed by the motor. It is important to note that the feedback described 
here is internal and not from the load (i.e., the cylinder/piston). Thus, for a 
constant current supplied to the servo amplifier, the valve motion, and hence the 
load motion, will be constant. 

The static characteristics of a typical flow control servo valve are shown in 
Figure 4.9.3. Here Q is the flow in gallons/minute, P, the supply pressure in psi, 
AP the differential pressure across the piston, i the input current (in milliamperes) 
to the torque motor, and i, the rated servovalve current. This figure reveals that 
full supply pressure can be transmitted to the load with currents that are a fraction 
(on the order of 1 to 5%) of the rated value. 

Servovalves having a wide range of operating parameters are available. For 
example, it is possible to obtain ones that have: 


TeCtig 


1. Flow rates from 2 to more than 500 gal/min. This corresponds to a powe! 


range of approximately 3 to more than 700 hp. 
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Figure 4.9.3. Static characteristics of a typical flow-control servovalve. (Rep 


tesy of Moog, Inc., East Aurora, NY.) 
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essures in the range 1000 to 3000 psi. Higher pressures produce 
ght and power efficiencies. 


| The Hydraulic Position Servo 
4.9. 
the hydraulic actuator described above can be used to replace a dc 


ctice, . ‘ 
In pra in a control loop. Hydraulic velocity, pressure (or force) control, and 


motor . ; ; 
or on servos can be configured in much the same way as they are with all electrical 
ponents. For robot applications, a position servo is usually employed for 
co 


ons mentioned previously. The idealized schematic and block diagram (with 
pee effects neglected) for such a device are shown in Figure 4.9.4. Although 
a servovalve/actuator would be used as an element in the control loop of a 
rismatic joint, rotary joint control could also be achieved if the cylinder/piston 
was replaced by an actuator that converted the fluid flow from the valve into rotary 
motion (i-e., a hydraulic motor). 

In Figure 4.9.4, Q, and Q are the servovalve no-load and output flows, 
respectively, A is the piston working area, and K,, the position transducer gain. 
In addition, K,, and K, are, respectively, the servovalve “droop” (due to internal 
fluid leakage) and flow gain with K, and K, actuator stiffness terms. Other terms 


are defined below. 
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The operation of this servo is similar to that already discusseq f 
vomotor. A _ position command voltage £, from the master micro = © ser. 
compared to the actual position as represented by E;, the output volta SSOr jg 
type of position transducer (e.g., a “pot” or in the rotary case, an Optical e SOm 
(Use of D/A conversion is assumed where necessary but is not explicith, r), 
here.) The resultant error signal is amplified by the servo amplifier (hay; ¥ Show 
K,,) to produce a drive current i. As explained above, this current cane Bain 
servovalve and actuator assembly to produce a force F which acts on th 8 ‘the 

ton € load m 
M. Asa result, the load will move toward the desired position (with veloc: - 
in the x direction) until the error E, is zero. ity V 

As mentioned in a previous section of this chapter, there will usually be ty, 
disturbances present when a position servo is used to control a robot joint (i.e 
friction and gravity). In Figure 4.9.4 these forces are represented by the term F. 
The reader will recall that such disturbance forces will cause a steady-state Position 
error. Thus compensation techniques must be employed to reduce or completely 
eliminate this unacceptable error (e.g., integral control; see Section 4.3.3). 

In view of our discussion concerning the need to limit final position overshoot 
during a joint move, it is reasonable to ask the question: What prevents the load 
from oscillating, that is, how is damping produced in the hydraulic position servo 
since Figure 4.9.4 does not reveal the presence of any velocity loop? This question 
does not have a single answer since a variety of techniques can be used. For 
example, due to the viscous nature of oil, it is possible to make certain structural 
modifications in the design of the servovalve which permit the required damping 
to be achieved. One such change causes the flow—pressure curves shown in Figure 
4.9.3 to become nearly linear and to have increased slope. It can be shown 
(although this will not be done here) that doing this directly increases the damping 
coefficient €. Thus, for a given application having a specified load, it may be 
possible to select the servovalve so that the proper amount of damping is provide : 

A technique that is often used to realize an increase in the slope of the _ 
pressure Curves involves deliberately introducing an appropriate leakage (or hrs ; 
path in the valve/actuator combination. Either laminar or sharp-edgec ae ng 
bypass designs can be employed, with the latter giving greatly increased . this 
at very low pressure drops. The major disadvantage of increasing the a dis- 
manner is that the static stiffness of the hydraulic system 1s reduced. | T error: 
turbance forces or torques such as gravity will produce a significant seen? joint 
Consequently, servovalves of this type are not the best choice for f° 
control. . t qaition 
The problem of static stiffness reduction can be overcome by severa’® citane’ 
modifications to the valve structure (e.g., utilizing a spring-centere ae line 
piston). ‘The resulting device is called a DPF servovalve and has the dew jent a" 


flow— pressure characteristic with the corresponding high damping cO0¢ - 
the required stiffness. cally: TH 
{t is also possible to achieve a similar damping characteristic electri" “ essul 


is accomplished by using load force feedback. Actuator force outpu 


atic Systems 
oe 4.10 Pneum y ~ 


eferential can be monitored using an appropriate transducer, 
diffe auch a device is then fed back to the servo amplifier, It can be shown that 
ie the load on the actuator increases, the valve current will decrease, thereby 
ve jocidg a corresponding reduction in flow. In fact, the feedback causes the 
‘fective flow-pressure curves to be very nearly linear (under load), which is the 


jesired result. Alternatively, a velocity sensor can be used to provide the extra 
damping, a8 discussed previously. 

Finally, a simple, nonelectrical method of obtaining the required damping is 
wvailable. That is, by externally attaching a passive viscous damper, similar to an 
automobile shock absorber, to an appropriate hydraulically actuated member, it 
is possible to limit endpoint oscillation significantly. A number of commercially 
available robots today utilize this approach on several of their axes. It is important 
to understand, however, that such an approach is not always practical for every 


robot joint because of space and weight restrictions. This is particularly true in 
the case of wrist axes. 


The electrical signal 


4.10 PNEUMATIC SYSTEMS 


Unlike the components found in hydraulic systems, pneumatic devices make use 
of a fluid medium that is highly compressible. This fluid is usually air and has the 
advantage that it is both readily available and nonflammable. Most frequently, 
hydraulic devices use oil in a closed system so that any leak necessitates the re- 
placement of the fluid and creates a fire hazard. Moreover, pinhole leaks in the 
high-pressure hydraulic hoses represent a significant safety hazard since the fluid 
escaping from these holes is almost invisible but can nevertheless punch a hole 
through many materials and also do quite a bit of damage to a human operator. 
In normal Operation, however, pneumatic devices are quite often deliberately vented 
'o the atmosphere, with the working medium (i.e., the air) actually being replaced 
at the completion of each work cycle, and the relatively low pressure makes them 
quite a bit safer to use. 
There are other differences between pneumatic and hydraulic components. 
°F example, oil is a highly viscous medium and air is not, Consequently, pneu- 
jilic systems tend to exhibit highly underdamped dynamic behavior, whereas 
tere systems tend to be fairly well damped, Another major raid 
a the two has to do with stiffness. Air-actuated systems _ highly a ' “ 
“USE of the compressibility of the working medium. Oil is not as easily co 


Pressed, so that hydraulic devices tend to be far less compliant. By increasing the 


peratin f the problems 
wae pressur it j ‘ble to overcome some 0 
®8S0ciated a ©, however, it is possibl g to find that some 


§ ith pneumatic systems. Thus it is not surprisin pu ! 

= _ fairly simple cael aleeiees robots are pneumatically gn = 

i. “; Seiko makes a variety of this type of device. Also, in the : | are 

i Manufacturer, International Robomation/Intelligence (IRI), did pr fu soit 
| “omputer-controlled, air-actuated, servo-controlled robot which was cap 
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eds of up to 20 in./s (see Figure 1.3.20). Ans 
bot, possibly because its performance as Ough 
servomotor-driven units, its very existe ta 
ly encountered with Pneumatic en in. 
ems 


of moving 25-lb payloads at spe 
IRI no longer produces this ro 
“positive” as that of hydraulic or , 
dicates that some of the difficulties previous 


have been overcome. 
ion of a simple pneumat 
Let us briefly consider the operatio Pre P ‘© Proportion 


controller shown in Figure 4.10.1. The heart of the device IS a two-stage amplifie, 
In the first stage, often referred to as a flapper valve amplif ler, the error linkag. 
position x controls the pressure P,, which, in turn, determines the position Y ofa 
metering valve for the second-stage amplifier. Called an air relay, this second 
amplifier is capable of handling large airflows. 

An error signal e that causes the error linkage to move to the right Produces 
a corresponding decrease in the pressure P,. As a result, the metering valve MOves 
up, thereby bleeding less air to the atmosphere and making the output Pressure 
P, (i.e., the pressure to the system being driven) increase and approach the Supply 
pressure P,. It is observed that this action extends the feedback bellows, which 
moves the error linkage to the left (z increases). The converse is true when the 
error linkage moves to the left so that the system pressure is made to decrease, 
thereby causing the feedback bellows to contract (z decreases). Positional equi- 
librium of both the metering valve and feedback bellows is obtained through the 
use of springs having spring constants K, and Ky. (A, and A; are the areas of the 
metering valve and feedback bellows, respectively. ) 


Pneumatic Amplifier —.e 
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| Linkage 
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Figure 4.10.1. Pneumatic pr 
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Figure 4.10.2. Pneumatically controlled prismatic joint. 


Other pneumatic controllers can be constructed by adding additional features 
to the basic proportional device in Figure 4.10.1. For example, derivative action 
is produced by inserting a properly shaped restriction in the feedback line between 
the system output pressure P, and the feedback bellows. Integral control is ob- 
tained by adding another bellows on the left-hand side of point z. Clearly, it is 
also possible to combine these actions to obtain a pneumatic PID controller. 

Any one of the devices above can be used to drive a prismatic joint of a 
robot, as shown in Figure 4.10.2. The four-way valve and cylinder/piston sa 
ment operate in a manner similar to the corresponding hydraulic device Oescree 
type pneumatic motor. This device produces a torque 7 fs Li aed 
rontroller output pressure P, and 1s nse spunk ret : ewe limited to 

As mentioned above, pneumatically actuated roDo’s a® Mt” point without 
small devices that are used to move light payloads oerk exception.) High- 
regard to the actual trajectory. (The IRI robot be a erally simple moves (€.8.. 
nee compressed air permits fast, ree being utilized to stop the indi- 
Oncoordinated) with mechanical limit stops often 4 controlled trajectory, must 
vidual joints. However, where large loads, se are normally employed. 

c handled, either servomotors or hydraulic nctUAten 
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to convert the low-power 


fa d”’ 
hen ‘“‘processe 
d are t Pp ; 


r must be used 


mputer an th we 
ie or drive the joint mot 
eu 


AS shown in 


Figure 4.2.2, a servo amplifie 


gnals that come from the mas 
aes Joint computer to levels that can 
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Chap. 
amplifier that can provide the necessary logic and drive for a ste 
described in Section 4.6.6. In this section we consider Possible co 
can be used to drive a dc servomotor. Specifically, pulse-width-m 


and linear amplifiers incorporating voltage feedback or voltage 
back will be discussed. 


nfigur ation : 
S 
Odulateq (Pwr! 


and current feeq. 
4.11.1 Linear Servo Amplifiers 


Two basic classes of linear servo amplifiers exist: (1) the H type and 
These are shown in Figures 4.11.1 and 4.11.2, res 


H, Is sometimes called a bridge amplifier, and has the advantage of requiring a 
single or unipolar dc supply. However, it is not always easy to operate in a linear 
fashion, and because the motor must be ‘floated’? with respect to the system 
ground, current and/or voltage feedback is not easy toachieve. In actual Operation, 
one set of dia turned on [e.g., O, and QO, (or Q, and 
Q;)]. It can be seen that if the first of these sets is made to conduct by applying 
a positive control voltage to channel 1 (and grounding channel 2), the armature 
voltage V,, = +V and the motor will 


turn (e.g., in the clockwise direction). 
When the control Signals on channels 1 and 2 are reversed, the second set of 
transistors conducts, thereby making V,, => —V. The motor will now turn in the 


opposite or counterclockwise direction. The actual size of the armature voltage, 
and hence the motor speed, will depend on the amount of base current supplied 
by the control circuitry that precedes the power amplifier stage (e.g., a preamplifier, 
not shown in Figure 4.11.1). 

The second general type of servo am 
as shown in Figure 4.11.2. However 
not have to float with respect to 


| (2) the T type. 
pectively. The first of these, the 


plifier, the T, requires a bipolar dc supply, 
, It is easy to drive and since the motor does 


ground, current and/or voltage feedback is easy 
to implement. Since complementary power transistors are employed (see Figure 


4.11.2), a single bipolar control signal can be used to turn on either Q; oF es 
thereby making V4, either = + V or = — V and producing the desired bidirection’ 
rotation. In the T configuration, it is important to bias the transistors sO that 2 
and Q, are not both on at the same time since output transistor failures are likely 
to occur if this happens (i.e., they conduct simultaneously). 

An undesirable characteristic of a T servo amplifier is the ‘“‘deadban a 
“crossover distortion”’ that exists around zero output voltage. This produces 
armature drive voltage that is a nonlinear function of the servo amplifier input ing 
small positive and negative inputs Signal. The problem can be reduced by cn 
both transistors on around the zero-voltage region. From what was said 4 a 
it is clear that care must be taken to prevent simultaneous operation of the 
sistors from occurring when large currents flow, do not 

It is important to note that the amplifiers in Figures 4.11.1 and 4.11.2 antid 
have any type of flyback protection shown, However, this is absolutely °° 
since the inductance in the servomotor armature can produce an ‘“‘inductiv© 
when the power amplifier transistors are either suddenly all turned off oF 


d”’ ol 
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Channel 1 


Channel 2 


Figure 4.11.1. 


current /, is shown for channel 1 high and channel 2 low. (Redrawn with permission 
of Electro-Craft Corp., Hopkins, MN.) 


‘‘H” type servo amplifier (one power supply required). Path of 


the motor is “plugged” (1.6. 
dynamic breaking). 

Which configuration i 
the power transistors 
terminals of the out 


, the armature voltage is rapidly reversed to provide 
Recall the discussion of Section 4.6.6. Thus regardless of 
s used, flyback diodes (or some other method of protecting 
from breakdown) must be placed across the collector—emitter 
put transistors. Failure to do this risks a collector-to-emitter 


+Voc 


Figure 4.11.2, ““T” type servo ampli- 
fier (two power supplies required). 
(Redrawn with permission of Electro- 
Craft Corp., Hopkins, MN.) 
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os ; : cause a runawa 7 
short circuit, which, as explained previously, tle ions , condition— a, 
especially dangerous occurrence in robotic appiic hy . 

There are other factors that must be considered when working with 
servo amplifiers: for example, the power dissipation capability of both the 
transistors and the associated heat sinks, the need to provide some type of 


linear 
POWer 


ACtive 
cooling (e.g., by using a fan), and the need to protect both the power transistor. 
and the motor from current overloads by using current limiting. The last Of these 


factors is particularly important in robotic applications since it is not at all uncom. 
mon for a stall to occur in the middle of a move due to the manipulator comin 
into contact with a foreign object that has accidentally found its way into the 
workspace. Clearly, one or more motors will stall in this case and some type of 
protection is absolutely essential in order to prevent amplifier and/or motor damage 
or destruction. Current limiting is one such technique, although fusing of motors 


and software methods (i.e., implementation of “timeout” criteria; see Section 4.4.4) 
are also often employed. 


4.11.2 Pulse-Width-Modulated Amplifiers 


One of the major difficulties with the linear amplifiers described in the preceding 
section is that, very often, the output is only a fraction of the total supply voltage, 
for example, during the initial or final portions of a move or when the move is 
deliberately performed at low speeds. This is accomplished by operating the power 
transistors in their active (i.e., linear) regions, which means that the collector-to- 
emitter voltage drop Vc, of the transistor(s) that is (are) conducting is significant. 
Consequently, the power dissipated in the collector (i.e., the product of collector 
current and the collector-to-emitter voltage) can be large (on the order of tens of 
watts and sometimes as high as 100 W), so the transistors and heat sinks must be 
sized accordingly. Although it is certainly possible to obtain these large transistors 
with the technology currently available, the added cost incurred is not always 
warranted. Fortunately, it is now possible to use a different approach that }s 
generally more cost-effective (i.e., pulse-width modulation, PWM). 

With the advent of power transistors that can be switched at megahertz rates, 
the use of PWM amplifiers to drive servomotors in robotic applications, as well as 
other incremental motion applications, has become quite practical and attractive- 
The major advantage of a switched device over a linear device is that in the forme: 
the power transistor is either “off” or in (or close to) saturation. In either cas® 
the power dissipated in the collector is considerably less than in an equivalent jineat 
amplifier. ‘This is easily understood by recognizing that since little or no collecto! 
current flows when the transistor is turned off, the power dissipation is quite small. 
When current does flow, however, the transistor is in saturation, which means thé 
the drop across its collector is only 1 or 2 vy. Thus the dissipation is still quit 
small (i.e., under 12 W for a continuous armature current of 6 A). An equiva E™ 
linear device might dissipate 72 W (assuming a 12-V drop across the collector): 


Just as with linear servo amplifiers, PWM devices can be of the H oF T type 
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and the same comments concerning the advantages and disadvantages of both are 

ertinent (see Figures 4.11.1 and 4.11.2). However, unlike the linear case, the 
output voltage of the T or H circuit will be almost equal to the full value of either 
the positive Or negative dc supply voltage (see Figure 4.11.3). 

How can these types of signals provide the required variation in armature 
voltage and hence rotor speed? The answer to this question is found by recognizing 
that the servomotor is a low-pass filter [e.g., see the transfer function in Eq. (4.3.5)]. 
With 7, defined as the period of the switching signal waveform, then if the radian 
switching frequency wo; = 27/T; >> wr, the electrical pole of the motor (i.e., ws 
> 100 w,), the filtering action of the motor will cause the effective armature voltage 


to be the “average value” of the waveforms in Figure 4.11.3.* Mathematically, 
this means that 


1 Ts 
Vv = | 4.11. 
Va ave T. Jo Varm(t) dt (4.11.1) 


Thus applying Eq. (4.11.1) to the waveforms in Figure 4.11.3, it is seen by inspection 
that the motor will not move for the square wave in part (a) because (V,,,)ave = 
0, whereas the nonzero average value of this quantity for the waveforms in (b) and 
(c) will produce rotor motion. It is important to understand that Eq. (4.11.1) will 
not be strictly correct if the switching frequency is too low. For example, if it is 
only about 10 times higher than the electrical pole of the motor, the effective 
armature voltage will be somewhat less than the average value and the armature 
current may exhibit significant ripple (see Problem 4.33). 

In actual use, a PWM servomotor drive can be made to produce practically 
any type of acceleration, velocity, or position profile that might be required in a 
given application. For example, if it is desired to cause a servomotor to turn with 
a trapezoidal velocity profile (see Figure 4.6.7), this can be achieved by making 
the pulse width, 7, in Figure 4.11.3, vary trapezoidally with time (see Problem 
4.34). In a robotic application the joint processor converts the velocity error 
Samples into equivalent values of T,. This is accomplished by causing the asso- 
ciated control logic to command the appropriate power transistor(s) in the PWM 
amplifier to turn on for T,, milliseconds, In view of the discussion of the preceding 
Paragraph, faithful reproduction of the desired profile will occur only provided that 
the switching frequency is “high enough.” This statement, in effect, implies that 
the frequency must be chosen so that the sampling theorem is satisfied. 
. Unlike the linear servo amplifier, there is another cause of power dissipation 
Ina PWM device, and this places a practical upper limit on the switching frequency. 
EE Eee 


“Recall that a periodic waveform such as a square wave can be represented by a Fourier series: 
Vent) = Vac + dy [A, Cos (nwst) + B, sin (nwsé)] 
nel 


If this signal is passed through a low-pass filter network with a cutoff frequency below w, (and 
hence nws), only the dc term will be transmitted, and the output will be V,.. 
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Varm(t) 


+V 


(a) 





(b) 


Varm(t) 


+V 


(c). 


Figure 4.11.3. Typical PWM waveforms: (a) no load PWM output, _ aw 
(Virm)ave = 9, motor does not turn; (b) loaded PWM output, ideal switch, Met 
ce V/2, motor turns CCW; (c) Same as part (b), except nonideal sw! 
power transistors in active region during T.. 
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Since switching cannot physically occur instantaneously but rather takes a finite 
time 7,, the power transistors spend a portion of the switching cycle in the active 
region (see Figure 4.11.3c). If the switching rate is extremely high, it is possible 
for this time to become a significant portion of the overall switching period, with 
the result that the overall power dissipation can be quite large, approaching that 
of the linear case. Asa soutinl, practical PWM servo amplifers usually work 
at switching rates of 1 to 15 KHz. (The lower limit is often determined by human 
factors, since a low-frequency switching rate can produce annoying and sometimes 
intolerable audible noise.) 


4.11.3 Effects of Feedback in Servo Amplifiers 


In this section the effect of using voltage, current, and combined voltage and current 
feedback with the power amplifier is considered. The reader should recall that 
the use of feedback can “stabilize” whatever quantity is being fed back. Thus, in 
the case of voltage feedback, an amplifier’s output voltage is held constant re- 
gardless of changes in the load’s impedance. This is sometimes referred to as a 
voltage-stabilized amplifier. 

Figure 4.11.4 shows the voltage—current characteristics for an amplifier with 
voltage feedback and a corresponding op amp implementation. Note that the 
intersection of any single constant resistance line with a particular constant-voltage 
output curve defines an operating point. It is important to understand that re- 
gardless of the value of the load resistance, the voltage-stabilized amplifier will 
produce an output Vou which is proportional to both the input V;, and the gain 


factor V,, (units of v/v). 


As stated in Section 4.11.1, the use of voltage feedback can reduce the dead- 
band in a T amplifier configuration. The feedback will cause the appropriate drive 
signals to be applied to the transistors so that the output voltage will be a linear 
function of the input voltage and the gain. Figure 4.11.5 indicates how a T power 
stage may be driven by an op amp having voltage feedback. Note that to reduce 
zero crossover distortion, the signal to be fed back must be obtained at the output 
of the transistors, not at their bases. 

The advantage of using an amplifier with voltage feedback for motor control 
is that the voltage delivered to the motor terminals will be kept at the value 
commanded by the input. This is important because control strategies discussed 
so far adjust the applied voltage via the amplifier in an effort to control the position 
or velocity of the motor shaft. In fact, if power dissipation is not a problem, the 
voltage-stabilized amplifier used with an unregulated power supply (sized such that 
its loaded output voltage is still in excess of that required to produce the desired 
motor performance) can ensure that the voltage and current delivered to the ser- 
vomotor are predictable despite fluctuations in the power supply (caused by line 
voltage variations, for example). In addition, for a multiple motor system (such 
as that utilized in a robotic manipulator) that employs a single supply, the gain of 
each motor’s voltage feedback amplifier can be adjusted so that for the maximum 
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Figure 4.11.4. Voltage feedback am 


plifier: (a) V-] . = 
circuit diagram. (a) Operating characteristic; (b) 


allowable input signal, the output voltage delivered does not exceed some Prt 
defined maximum value. 

F igure 4.11,6 shows the operating characteristics for an amplifier that has ¢ 
stabilized current output, In this configuration, the output of the amplifier 1s 4 
constant current defined by the product of the amplifier’s ai A; (units of ampere 
volt) and the input voltage, Ag the load varies, the aaa ut voltage changes in 
order to keep the output current constant, This ty e of pia lifier is used when it 
is desired to adjust the current across the motor teowiicale (e. ~ ia a torque contro 
application), One advantage of using such a device with de sevicennot is the 


armature resistance (which, it will be reca| 
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Figure 4.11.5 “‘T”’ type power stage driven by an op amp with voltage feedback. 


to the motor will not affect the power delivered to the motor. This is clearly a 
benefit in high-performance systems. 

If both current and voltage feedback are incorporated into the same amplifier, 
the operating characteristics are aS shown in Figure 4.11.7. This particular con- 
figuration may also be viewed as a voltage-stabilized amplifier to which a fixed 
series resistor has been added. The resistance value is defined as (V,/I,) ohms, 
where V, is the amplifier’s open-circuit voltage and J, the short-circuit current. A 
major advantage of combining the two types of feedback is that the power dissipated 
in the armature or the torque produced under stall conditions may be controlled. 
(In the case of a voltage-stabilized amplifier, the stall current is determined by the 
output voltage and the motor’s armature resistance and produces a torque defined 
by Eq. (4.3.3).] 

If it is desired to limit the torque at stall, possibly to prevent damage to a 
transmission or coupler attached to the motor’s shaft, it is necessary to limit the 
Output current. One way to accomplish this is to put a resistor in series with the 
motor’s terminals, thus effectively increasing the armature resistance. It should 
be obvious to the reader that while such an approach would work, the size of the 
resistor could be physically quite large in order to accommodate the required heat 
dissipation. As will be seen below, the simultaneous use of voltage and current 
feedback with an amplifier can achieve the same result without the use of an external 
Power resistor. Of course, power must be dissipated in the transistors of the power 
Stage, but this is generally preferable to employing a large and possibly costly 
resistor. . . 

We now demonstrate the current-limiting effect obtained by utilizing simul- 
taneous voltage and current feedback. Using the component designations shown 
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R. = R,; 
Vout 
Q, 


R2<R, 


A; Vin 


(a) 






Rinl|Re 


Re 

[= R, Re Vin 
IL =Ai Vin 
R,< <R, 
R,< <Rp, 


(b) 
Figure 4.11.6. Current feedback amplifier: (a) V-J operating characteristic; (b) 
circuit diagram. 

; os nd to 
in Figure 4.11.7, the input-output relationship for such an amplifier fou 
2) 

R,, R , 4.11. 

Y ani = a [_R, — ( 
Rin Rey 
Note that the configuration is that of an inverting summing amplifier. cite si8™ 
jimiting results because the two input voltages (V,,, and /,R,) have oP > and 
Equation (4.11.2) is plotted in Figure 4.11.8 for three values of Vin \~ ”’ 


—V; 


_ 


at 
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Vout 


R, =R, 







Vo 


Operating Points R2<R, 


V,.= Output voltage with no load 
lo =Short circuit output current 


R,< <R, 
R,< < Ret 


(b) = 


Figure 4.11.7. Combined voltage and current feedback amplifier: (a) V-J oper- 
ating characteristic; (b) circuit diagram. 


~3 V) and three load resistances (0.1, 5, and 10). For the values used (see the 
table at the bottom of Figure 4.11.8), Eq. (4.11.2) reveals that the effective series 
resistor is 2.22 0. As stated above, this amplifier may be modeled as a voltage- 
Stabilized amplifier whose load includes the series resistor equal to this value. To 
lustrate, consider the intersection of the constant-resistance line of 5 Q with the 
VG = — 2-V line in Figure 4.11.8. At the operating point (Q;), the output current 
1s 1.94 A, with 9.7 V being supplied to the load. The same result can be obtained 
Y using 14.0 V as the output of a voltage-stabilized amplifier having a total load 

of 7.22 O (S.0 + 2.22). 
In any one of the configurations just discussed, there are practical limitations 
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Figure 4.11.8. Load-line analysis for amplifier with combined current and voltage 
feedback. 


that place bounds on the operating characteristics of the devices depicted in Fi 
4.11.4, 4.11.6, and 4,11.7. Such considerations as the ratings of the compo iet 
and the available voltage and current from the power supply driving the OP het 
may be used to define usable operating ranges for the two axes. In addition; ats: 
circuitry may be added to prevent damage to the amplifier or other syste™ me “ip 
These circuits will usually operate only if a certain parameter is exceeded , at tbe 
general, can produce a variety of actions. For example, a fuse will disconne ent 
amplifier and load. Also, hard limiting can be implemented whereby the 
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is held at a fixed maximum value as the output voltage drops (i.e., short-circuit 
protection). Finally, it is possible to use current foldback, which produces a si- 
multaneous reduction in the output current (once some predetermined maximum 
current has been reached) as the output voltage drops. 

The remainder of this section is devoted to a discussion of the effects of each 
of the three types of amplifier configurations on the motor transfer function. 


4.11.3.1 Voltage amplifier driving a servomotor 


A dc servomotor driven by an amplifier utilizing voltage feedback is shown 
in Figure 4.11.9a. As discussed in previous sections, this amplifier usually consists 
of a power stage preceded by a preamplifier (normally implemented by an op amp). 
The characteristic of the device is that it has a low output impedance and is therefore 
termed a voltage amplifier. It is convenient to think of a system utilizing this 
group of components as producing a voltage-controlled velocity. 


Ry 





Servomotor 






with Voltage 
Feedback 





| 
| 
! Amplifier 
| 
| 
| 


(b) 


Figure 4.11.9.; (a) Servomotor driven by an amplifier utilizing voltage feedback; (b) block 
diagram representation of part (a). [Part (b) redrawn with permission of Electro-Craft Corp., 
Hopkins, MN. ] 
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The voltage amplifier itself will have a finite bandwidth, and in mog 


; . Tob 
applications a single-pole model will adequately represent its frequency resndie. 
(see, e.g., Section 4.4.2). Thus we will assume that its transfer function jg Siver 
by 

Vour(S) — Av 4 
Vin(S) 1+ STA ( 11,3) 


where 1/1, is the amplifier radian frequency bandwidth and A,, is the Magnitude 
of the gain, given by the relationship 


Ry 
yl = 2 (4.11.4) 


Figure 4.11.9b shows a block diagram representation of a dc servomotor driven by 
such an amplifier. The overall transfer function of this configuration is obtained 
by multiplying the transfer functions of Eqs. (4.3.5) and (4.11.3) and relates the 
motor shaft speed (transform) to the input voltage (transform). Thus 


Q(s) = (K7/L,J7) Avs 
Vin(s) s? + [(R,J7 + L,B)/L,Jr]s + (KrKe + R,B\V/L,J7( + st4) (1 + st,) 





(4.11.5) 


The important point to note in this equation is that the use of voltage feedback 
has not affected the location or the motor poles. This, of course, assumes that 
no loading exists between the two devices, which is true for a zero-output impedance 
amplifier. 


4.11.3.2 Current amplifier driving a servomotor 


An alternative method of driving a servomotor is with a current amplifier 
(high-impedance source), as shown in Figure 4.11.10. The reader will recall that 
an amplifier with current feedback produces a constant output current for a given 
input voltage. Examination of the dynamic equations of a dc servomotor reveals 
that this implies that the terms associated with the electrical behavior (e.g., ar 
mature resistance and inductance together with the back EMF constant) do 10 
influence the current actually being delivered to the motor.* By using the Laplace 
transforms of Eqs. (4.3.3) and (4.3.4) and ignoring the constant-torque terms (for 
the same reasons given in Section 4.3.1), the relationship between motor velocity 
and current is given as 


KyI,(s) = (sJ> + B)Q(s) (4.11.9) 


eer 
*This, of course, assumes an ideal current source ca 
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Figure 4.11.10. (a) Servomotor driven by an amplifier with current feedback; (b) 
block diagram representation of part (a). [Part (b) redrawn with permission of 
Electro-Craft Corp., Hopkins, MN. ] 


If Eq. (4.11.6) is rearranged to obtain a transfer function relating armature current 
to shaft velocity, we have 
O(s) Kr 
I(s) Syr+B 
Equation (4.11.7) can be viewed as modeling a device that produces a current- 


controlled velocity. Another way of looking at this result is to recognize that since 
torque is proportional to armature current, a current amplifier actually produces 


torque control. 





(4.11.7) 


304 Control of Actuators in Robotic Mechanisms 


Chap, 4 
In reality, the current amplifier has a finite bandwidth and can be 
as MOdeleg 
Tout(S) _ _ Ai 
Vs) 1+ st, (4.11.8) 


where 1/7, is again the amplifier bandwidth and A;, the gain of the am 


| Plifier (y,; 
of amperes/volt), is a function of the input, feedback, and sense resistors ti 
1S, at 


R, 
Rink, (4.11.9) 


In Eq.(4.11.9) it is assumed that R, << R,. 


The overall transfer function of a motor driven by a current amplifier is the 
product of the transfer functions in Eqs. (4.11.7) and (4.11.8), so that 


Ms) _ __ KA, 
Vin(S) (SJ + B)(1 + st) (4.11.10) 


Figure 4.11.10b shows a block diagram representation of this system. Comparison 
of Eqs. (4.11.5) and (4.11.10) indicates that the poles of the motor have been 
altered by the use of current feedback. In fact, the motor is seen to behave like 
a one-pole, rather than a two-pole device. Note that only the mechanical param- 
eters of the system (i.e., the total inertia J; and the viscous damping B have an 
effect on the behavior of the servo. It can be shown that the elimination of the 
pole (sometimes referred to as the electrical pole) due to the armature elements 
results in a larger velocity loop bandwidth (see Problem 4.42). 


Aj — 





4.11.3.3 Current and voltage feedback amplifier driving a servomotor 


Often, it is necessary (and desirable) to both limit the power that can be 
delivered to the motor and also increase the velocity loop bandwidth. This can 
be accomplished by combining the results of the two preceding sections to form 
an amplifier that utilizes both voltage and current feedback. Such a configuration 
is shown in Figure 4.11.1la. By examining the corresponding block diagram (shown 
in Figure 4.11.11b), it is seen that this system has a more complex structure than 
those previously discussed. | a 

It can be shown that the transfer function relating the shaft velocity to 
input voltage is given by (see Problem 4.38) 


Os) _ AvKy 
Vi(8) (1 + stq) [(SL, + R,) (sJp + B) + K,K;] + AbR, (sJ + B) 
(4.11.10 
and 
where b = (R;,/R,) and A,; = (R,/R,,). A comparison of Eqs. (4.11.11) af 


(4.11.5) reveals the presence of an additional term in the denominator, which; 


< 
=] 
*! 
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Ficure ery ny ga the pole locations. Note that the impleme Nap. g 

Viehih hans ire a eed of an inverting amplifier. If this Pr Wn 
€ of Eq.(4.11.11) would need ; Ult igs in 

velocity and in ed a negative sign to jing;.... “Sed, 
. put voltage are 180° out of pha i indicate that ne 
iMversions Occur throu a phase with each other at th 
ghout the circuits used to imple ~ In pracg° 
signs tend to cancel. Th plement a loop and “tice 
us they may be ignored in the DE Negatiy. 

ak : a at 
correct a. of the signals exist in the loop. nalysis as long as the 

O obtain a good understandin 
es g of how the motor pol 
plifier with both current and voltage feedback, consider the ‘cafe bY usin 


merical example. 


EXAMPLE 4.11.1 


Let us find the poles of a motor—amplifier configuration such as that sh 
in Figure 4.11.11 for varying degrees of current feedback. The following are 
e 


the assumed system parameters: 
Motor parameters 


Ky; = 11.9 oz-in./A 

Ky, = 0.084 V/rad/s 

L, = 0.0047 H 

R, = 2.240 

Jy = 0.0054 oz-in.-s* 

B = _ 0.00288 oz-in./rad/s 


Resistor values 


R;, = 214 kQ 
Ry = 1.5 MQ 
Ry = 270 kO 
R, = 0.40 
med that the load inertia is zero i sot : f the oper 


Note that we have assu 
Utilizing these resis 
loop system consisting of the amplifi 
resistive load indicates that there 1s a pole at abou 
to note that this oy 1S angers . the — 
‘on and the voltage gain chosen |-}. . : 
TO nee the effect of current feedback on the pole locations: we 


tor values in the amplifier, a Bo ing @ 
er (with no current feedback) driv nt 

bout 7000 Hz. ItisiMP. ihe 

lar op amp used ™ 
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TABLE 4.11.1 SYSTEM POLES AS A FUNCTION OF THE 
CURRENT FEEDBACK 


eee 





b=0 b = 0.4 b = 0.79 b = 1.6 
Pi — 107.4 — 60.9 — 44.2 — 28.6 
P2 — 369.8 — 658.0 —914.3 — 1,435.5 
P3 — 44,000.0 — 43,758.0 — 43,518.6 — 43,014.0 





four values of the parameter b (e.g., 0, 0.4, 0.79, and 1.6). The resultant 
system poles for each of these are summarized in Table 4.11.1. From these 
results it is observed that when b = 0, the current feedback is disabled and 
Pi, P2, and p3 are, respectively, the motor’s mechanical and electrical poles 
and the pole of the amplifier. As current feedback is increased (the value 
of the parameter b is increased) the motor’s mechanical pole moves toward 
the origin while its electrical pole moves in the opposite direction. In terms 
of Bode plots, current feedback increases the point where the 0-dB crossover 
occurs (i.e., the bandwidth). For example, if a velocity loop were to be 
implemented with a motor—amplifier and b = 0, the maximum bandwidth 
can be shown to be about 370 rad/s. However, when b = 1.6, the corre- 
sponding bandwidth is increased by almost a factor of 4. Note that the 
amplifier pole is relatively insensitive to variations in b. 





4.12 SUMMARY 


In this chapter we have presented a detailed discussion of the typical control 
structure used in each of the joints of a modern industrial robot. It has been 
demonstrated that we must ensure that the position servo bandwith is large enough 
to reproduce faithfully the profile of the desired position (thereby keeping the 
tracking error well within bounds) but not so large as to permit the servo to respond 
to the individual updates (i.e., the set points). It has also been found necessary 
to include an integrator as part of the servo loop’s compensator due to the grav- 
itational and friction disturbances that invariably act on most of the joints of a 
robot. Thus it is not surprising that a typical robot servo utilizes a PID controller. 
We have also found that most robots either employ a single position sensor (on 
each axis, e.g., an incremental encoder), and derive the velocity digitally from the 
information provided by this device, or else both an encoder and an analog tach- 
ometer are utilized to provide the required position and velocity data. 

In addition to the material on the operation of the servo itself, we have 
presented detailed information on a variety of robotic actuators, including the dc 
servomotor, stepper (both rotary and linear) and brushless motors, and finally, a 
novel type of direct-drive motor that has already been incorporated into a com- 
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mercial, high-performance robot. Besides these, hydraulic and pneuma 
tors, as they apply to robots, have been presented. 
The last portion of the chapter has been concerned with the different 

of servo amplifiers that can be employed, including linear and PWM device, 'YPes 
advantages and disadvantages of both types have been discussed. In additio, 4° 
Importance of utilizing flyback diodes to protect the power transistors ict ye 
“inductive kick” has been stressed. Finally, the effects on the performance i % 
servo (e.g., on closed-loop pole placement) when voltage, current, or a 
voltage and current feedback amplifiers are employed has been demonstrateg 7 


tic Actua. 


4.13 PROBLEMS 


4.1 For the open-loop transfer function given in Eq.(4.2.1), sketch the root locus shown 
in Figure 4.2.3. In particular, obtain the expression for o,, the centroid of poles and 
zeros; o, the point where the root-locus “breaks away” from the real axis; K,, the 
gain where this occurs; and the radian frequency where branches of the root-locus 
cross the imaginary axis. Also show that for K >(1/7, + 1/t,,) the closed-loop system 
in Figure 4.2.2 (with K, = 0) is unstable. 

4.2 Find the expression for the step response for the closed-loop system in Figure 4.2.2 
(with K, = 0). Thus show that if Ky < K < (1/1, + 1/ty,), this response will be 
similar to that shown in Figure 4.2.4. 


4.3 Derive Eq. (4.2.4). 
4.4 Derive Eq. (4.3.5) from Figure 4.3.3. 
4.5 For G,,(s) the transfer function of the servomotor given in Example 4.3.1: 
a. Find and plot the step response. That is, for V,,,,(t) a unit step voltage, find w(*). 


b. Find and plot the armature current /,(t). 
c. Also find the maximum value of this current and the time at which it occurs. 


4.6 Verify Eqs. (4.3.6) and (4.3.7). 
4.7 Verify that if the position loop in Figure 4.3.5 is closed with unity gain and K, is placed 
in the forward path (e.g., between the position and velocity loop summing points); 
the final value of the position to a step command of magnitude 0, will be Q,. Assume 
that the friction and gravitational torques are both zero. Also show that such @ 
modification does not affect the dynamic response of the system. That is, show that 
the closed-loop poles of this system are identical to those in Eq. (4.3.7). 


4.8 For the position servo with PID controller shown in Figure 4.3.7 and a 
torque disturbance given by Eq. (4.3.12), verify the results shown in Fi 
Assume a step command (input) to the system of 1.57 rad and that Kp = 
— 75, Two values of K, should be used (i.e., 20 and 40). Note that som 
tational scheme that makes use of appropriate approximations will be require 
this problem since the disturbance input is a nonlinear function of the output. sil 


- ae .s 
For the open (position)-loop transfer function for the system in Figure a Using 
that when K, = 0, the system is type 0, whereas it is a type 1 when K; ady-state 
these results, also show that if the disturbance input is a step function, the sté 


il] be zero only if K, # 0. 


gravitational 


ure A> 7 
0.02 and Ky 
me compu- 
° d to do 


4.9 


error W 
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4.10 For the tach loop represented by the open-loop transfer function in Eq. (4.4.1), obtain 
the Bode magnitude and phase plots shown in Figure 4.4.1. For the magnitude plot. 
use straight-line approximations to assist in obtaining the actual curve. 

4.11 Applying the definitions in Eq. (4.4.5), show that the GM and PM for the tach loop 
in Figure 4.4.1 are 21.6 dB and 47°, respectively. 

4.12 For the open tach loop in Eg. (4.4.1), suppose that AK, = 5. 

a. Obtain the Bode plots for this new system and compare them with the ones in 
Figure 4.4.1, 

b. Find the GM and PM for this system. 

c. Obtain the approximate magnitude plot for the closed tach and compare it with 
that found in Figure 4.4.3. Show that the two curves differ initially by 14 dB and 
this decreases to 0 at w = 1166.4 rad/s. 

4.13 For the system in Problem 4.12, obtain the approximate closed-loop tach transfer 
function. 

4.14 For the closed tach loop: 

a. Show that the bandwidth for the approximate closed tach loop in Figure 4.4.3 is 
336.7 rad/s. 

b. Show that the actual closed tach bandwidth is about 714 rad/s. 

4.15 For the open position loop represented by the approximate transfer function in Eq. 
(4.4.8): 

a. Obtain the Bode plots for K, = 1 and show that they are identical to those in 
Figure 4.4.5. 

b. Show that the GM and PM are 59.1 dB and 89.8°, respectively. 

c. Show that the 3-dB closed position loop bandwidth is about 1 rad/s. 

4.16 For the open-loop transfer function in Eq. (4.4.8), let K, = 70. Using the approxi- 
mations for closing a loop, show that the GM and PM are 22.2 dB and 67.5°, respec- 
tively, and that the half-power bandwidth is about 67.5 rad/s. 

4.17 Repeat Problem 4.16 if K, = 100, thereby demonstrating that the gain and phase 
margins for the position loop are 19.1 dB and 68.2”, respectively, with the closed-loop 
bandwidth now about 94 rad/s. 

4.18 For the lead compensator used in Section 4.4.5: 

a. Show that the tach GM and PM are 19.2 dB and 73.4°, respectively, with a closed- 
loop 3-dB bandwidth of 927 rad/s. 

b. If K, = 100, demonstrate that the use of lead compensation in the tach loop causes 
the closed position loop bandwidth to increase to 98.6 rad/s. 

c. Moreover, show that with K, = 240, this bandwidth can be more than doubled to 
226 rad/s without causing the system to become unstable. 

4.19 For the stepper motor in Figure 4.6,1, show that making the phase excitation sequence 
A, D, C, B, A will produce counterclockwise rotation of 60°. 

4.20 Demonstrate that in order to be able to change direction, a stepper motor requires a 
least three phases, 

4.21 a. Prove that for a stepper motor, the step angle = 360° [|(N, — N,)|/N,N,], where 

N, is the number of stator teeth and N, is the number of rotor teeth. 

b. Also show that the number of steps/rev = N,N,/|(N, — N,))- 

4.22 For the motor in Figure 4.6.3, show that each step is 18° and that there are therefore 
20 steps/rev. 
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4.23 Using the trapezoidal velocity profile shown in Figure 4.6.7 in By na 
= 4000 steps/s and the acceleration and deceleration times sti] i le 4.6.4 Wit 
show that the acceleration torque is 5.5 oz-in., t, = 160 ms, and he ued to be . aa 
T = 410 ms. © Overall Move 4 
l 
4.24 For the motor having the force—velocity profile in Figure 4.6.11. ™ 
a. Compare the time needed to accelerate a 2-lb load to a maximy 
in./s by first utilizing the force available at 50 in./s (i.e., a nea Velocity of 
and then utilizing a three-segment piecewise linear velocity profile had 
shown in Figure 4.6.12. iti 
b. Develop a general procedure for acceleration that will find the minim 
a given load can be accelerated from 0 in./s to some maximum velnuts ee that 
the data from a force—velocity (F—V) curve and assuming that there nh spaces 
of constant force. (Note that if = 5, then five segments are to be pea ii 
force that can be employed for that segment 1s the minimum for the corres ‘on re 
region of the F—V profile.) pt 
4.25 If a linear stepper has a pitch of 0.040 in. and microstepping is used to divide th; 
distance into 400 microsteps (i.e., one microstep moves the motor 0.0001 in.) sha 
pulse frequency must be applied to the motor to achieve velocities from 0 to 60 in,/s? 
4.26 Design a controller (i.e., the block diagram) capable of achieving the pulse rates 
obtained in Problem 4.25. 
4.27 Investigate the use of “burst” in commercial stepper drivers. How is it implemented, 
and what performance improvement does it achieve? 
4.28 Verify that for an eight-pole, three-phase BDCM, with three sensors placed every 
120°, the sensor signals are those shown in Figure 4.7.3. 
4.29 Show that if a constant current flows in each phase of th 
will not be constant with respect to 9. 
4.30 For the base drive signals shown in Figure 4.7.6, sketch the phase 
of 8. Use these curves to verify that we get constant torque. 


coil pairs are energized. 
4.31 Sketch the actual phase currents J, 


Tation 
F to that 


e three-phase BDCM, Tec 


currents as a function 
Also indicate which 


fall 
»» Ipc, and I, as f(8), assuming that rise ~ 
d for both cases *™ 


times are the same. Assume 10 and 20° to reach peak, an sappensi 

actual torques produced by each phase and the overall torque Ten: What hapP 

the fall time is essentially zero? | ne B pcm 
ive signals that will cause Figure 


4.32 Determine the appropriate sequence of base dr als shows n 


to rotate in a direction opposite to the one produced by the Sig 


whi cy is only abou! 
4.33 Show that for a PWM driving a servomotor, ‘f the switching freque” o aad anguia! 
armature CUITE™™ © tor: 


10 times higher than the electrical pole of the motor, the ‘for the 
velocity may exhibit significant ripple. Assume a two-pole mode - 
. file © 
: city PIO the 
4.34 Show that a servomotor can be made to turn with a trapezoidal pot sign?! t0 
Figure 4.6.7), by making the pulse width 7, (duty cycle) of the 


motor terminals vary trapezoidally with time. 
4.35 Derive Eq. 4112) 
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4.36 


4.37 


4.38 


4.39 


4.40 


4.41 


4.42 


4.43 


4.44 


4.45 


4.46 
4.47 


Show that the equivalent series resistor in an amplifier with current and voltage feed- 
back is given by Rguiy = (R,R,)/Ry. 

Derive the characteristics of a voltage amplifier with a finite output resistance. Discuss 
how this affects the voltage and current delivered to a motor. Does the output resist- 
ance change the motor’s transfer function? Explain. 


Design a system consisting of five voltage-stabilized amplifiers (each driving a motor) 
being powered by a single unregulated power supply. The maximum input signal to 
each amplifier is +5 V. The maximum voltage and current requirements for each 
motor are as follows: 

47V at4.6A 

45.5 V at5.3A 

42.5 Vat4.0A 

34 Vat2.5A 

5. 26Vat2.0A 

Specify the regulation of the power supply in terms of the supply voltage. Also discuss 
the power dissipated in each of the amplifiers. 

Discuss how an amplifier with voltage and current feedback can be used to alter the 
transfer function of a motor. 

Determine how much of the actual power is delivered to the load and how much is 
“dissipated” in the series resistor for an amplifier with voltage and current feedback. 
Is the percentage the same if the operating point changes? Explain. 

If a voltage-stabilized amplifier is to drive a motor located a large distance from the 
amplifier, what precautions should be taken to ensure that the voltage delivered to the 
motor terminals is the value the designer wanted? Consider where the voltage feed- 
back should be connected and compare this to the ‘‘cost’’ of using a larger-gage wire 
in terms of wire flex capability, wire insulation temperature, and utilizing three separate 
conductors versus two (for example). 


Investigate the types of safety or shutdown circuits available as features in commercial 
power amplifiers. Discuss the advantages and disadvantages of each and how they 
can make a linear system behave in a nonlinear manner. 


What is the effect of a finite output impedance of a voltage amplifier on the transfer 

function of Eq. (4.11.5)? That is, derive a result similar to Eq. (4.11.5) assuming that 

the amplifier is modeled by a Thévenin voltage given by Eq. (4.11.3) and a nonzero 

Thévenin resistance R,. 

Prove that eliminating the electrical pole in the motor model as shown by Eq. (4.11.10) 

can result in a higher velocity loop bandwidth. Do the analysis in terms of Bode plots 

and comment on the 0-dB crossover frequency. For the same motor driven by a 

voltage amplifier, what is the maximum bandwidth that can be achieved? 

If a dc motor was to be used as a torque generator, define the transfer function. 

Discuss the advantage of using a current versus voltage amplifier to drive this motor. 

Derive Eq. (4.11.11) starting with Figure 4.11.11b. 

Assuming that t, = 0 so that the amplifier pole is of no consequence, 

a. Derive an expression for the poles of Eq. (4.11.11) as the current feedback param- 
eter b approaches infinity. 


yo 
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4.48 Repeat Example 4.11.1 with an additional load inertia J, of 0.02 OZ-in,-s2, 


b. Compare this to the root-locus plot of Eq. (4.11.5) as the value of R, (the moto, 
armature resistance) is varied from zero to infinity. Ors 

c. Compare the pole locations of Eq. (4.11.10) with those found in parts & b, 

~ Examine 

the trend in the poles as b increases. Are there any advantages of combined current 

and voltage feedback for driving a high inertial load? Explain. 


4.49 (optional) Explain the use of combined current and voltage feedback in terms of State- 


variable feedback. What states are fed back? Can the transfer function be Made 
into any second-order transfer function? Explain. 


4.14 REFERENCES AND FURTHER READING 


L. 


2. 


Dorf, Richard C., Modern Control Systems, 3rd ed. Reading, Mass., Addison-Wesley 
Publishing Company, Inc., 1983. 
Lynch, Paul M., “Minimum Time, Sequential Axis Operation of a Cylindrical, Two 
Axis Manipulator,” Proceedings of the 1981 Joint Automatic Control Conference, WP- 
2A, Vol. 1, Charlottesville, Va. 


- Nordquist, J. I., and Smit, P. M., “A Motion Control System for Linear (Stepper) 


Motors,”’ Proceedings of the Incremental Motion Society, University of Illinois, Urbana, 
Ill., May 19835. 


- Welburn, R., “Ultra High Torque Motor System for Direct Drive Robotics,” Proceed- 


ings of the Robots 8 Conference— Applications for Today, Detroit, Mich., June 4-7, 
1984, Dearborn, Mich.: Society of Manufacturing Engineers, 1984, Vol. 2, pp. 19-64 
to 19-71. 


. Chmielewski, Thomas, ‘‘A Note on the Effect of Amplifier Feedback on Closed: Loop 


Pole Placement,” in preparation. 


The following are excellent texts on various aspects of control Systems: 


6. 


10. 


Kuo, Benjamin C., Automatic Control Systems, 4th ed. Englewood Cliffs, N.J.: Pren- 
tice-Hall, Inc., 1982. Covers classical and certain modern methods in analog control 
systems. It includes good material on Laplace transforms, Bode plots, PID controllers, 
state variables, and design. 


. Melsa, James L., and Schultz, Donald G., Linear Control Systems. New York: McGraw 


Hill Book Company, 1969. Chapter 5 has an excellent treatment of Bode plots and 
minimum- and non-minimum-phase transfer functions. 

Kuo, Benjamin C., Digital Control Systems. New York: Holt, Rinehart and Winston, 
1980. An exhaustive treatment of digital control analysis and design. 


ail 
. Raven, Francis, H., Automatic Control Engineering, 2nd ed. New York: McGraw Hil 


MCU A 
Book Company, 1968. Classical analog control from a mechanical engineering PO!” 
of view. Includes a good discussion of hydraulic and pneumatic control systems. 


. | ae 
Eveleigh, Virgil W., Adaptive Control and Optimization Techniques. New York: — 
Hill Book Company, 1967. A good solid introduction to optimal and adaptive 


niques, 


Sec. 4.14 | References and Further Reading 313 


Li. 


Athans, Michael, and Falb, Peter L., Optimal Control. New York: McGraw-Hill Book 
Company, 1966. A comprehensive, classic text in this field. 


The following articles discuss various aspects of robotic controls: 


i, 


13. 


14. 


15. 


16. 


Dubowsky, S., and DesForges, D. T., ‘The Application of Model-Reference Adaptive 
Control to Robotic Manipulators,” Journal of Dynamic Systems, Measurement, and 
Control, ASME, Vol. 101, September 1979, pp. 193-200. 


Luh, J. Y. S., Walker, M. W., and Paul, R. P. C., “On-Line Computational Scheme 
for Mechanical Manipulators,” Journal of Dynamic Systems, Measurement, and Control, 
ASME, Vol. 102, June 1980, pp. 69-76. 


Luh, J. Y. S., “An Anatomy of Industrial Robots and Their Controls,” JEEE Trans- 
actions on Automatic Control, Vol. AC28, No. 2 (February), 1983, pp. 133-153. 


Asada, H., Kanade, T., and Takeyama, I., ‘“Control of a Direct Drive Arm,” Robotics 
Research and Advanced Applications, Proceedings of ASME Annual Meeting, Dynamic 
Systems and Control Division of ASME, 1982, pp. 63-72. 


Koivo, Antti J., and Ten-Huei Guo, ‘Adaptive Linear Controller for Robotic Manip- 


ulators,’’ JEEE Transactions on Automatic Control, Vol. AC28, No. 2 (February), 1983, 
pp. 162-171. 


Other references pertaining to the practical aspects of servo control. 


17. 
18. 


Moog Technical Bulletin 126. A good reference on hydraulic servo applications. 


Electrocraft Corporation, DC Motors, Speed Controls, Servo Systems, 1980. One of 
the best practical treatments of motors and servos. 


Robotic Sensory Devices 


5.0 OBJECTIVES 


In this chapter we describe the operation of a variety of sensory devices that either 
are now used on robots or may be used in the future. In general, it is found that 
some are inherently digital devices, whereas others are essentially analog in nature. 
Sensors can be divided into two basic classes. The first, called internal state sensors, 
consists of devices used to measure position, velocity, or acceleration of robot 
joints and/or the end effector. Specifically, the following devices that fall into this 
class will be discussed: 


Potentiometers (‘‘pots’’) 

Synchros 

Resolvers 

e Linear inductive scales 

e Differential transformers (i.e., LVDTs and RVDTs) 
e Optical interrupters 

e Optical encoders (absolute and incremental) 

e Tachometers 

e Accelerometers 


The second class, called external state Sensors, is used to monitor the robots 
geometric and/or dynamic relation to its task, environment, or the objects tha! it 
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is handling. Such devices can be of either the visual or nonvisual variety. The 
former group of sensors is treated in Chapter 6. In this chapter we discuss tech- 
niques that permit the monitoring of (1) distance from an object or an obstruction, 
(2) touch/slip, and (3) force/torque. Specifically, the following will be covered: 


Strain gages 

Pressure transducers 
Proximity devices 
Ultrasonic sensors 
Electromagnetic sensors 
Elastometric materials 


The various aspects of the important topic of tactile sensing are presented in 
some detail. Welding sensors, devices that are probably the most advanced ex- 
ternal robotic sensors, are also discussed. 


5.1 MOTIVATION 


As we have seen in Chapter 4, the successful control of most robots depends on 
being able to obtain information about the joint and/or end effector. It is therefore 
necessary to have devices (transducers) that provide such information and can be 
readily utilized in a robot for this purpose. In particular, position, velocity, and/ 
or acceleration (or at least analog or digital representations of these quantities) 
must be measured to ensure that the robotic manipulator moves in a desired manner 
(e.g., a straight line) with little or no oscillation (i.e., overshoot) at the final 
These so-called ‘internal state sensors” must not only permit the re- 
quired degree of accuracy to be achieved, but they must also be cost-effective since 
each of the robot’s axes will normally utilize such devices. As a consequence, the 
sensor selection and the decision to place it either on the load side or on the output 
of the joint actuator itself is influenced by such factors as overall sensor cost, power 


needs for a particular joint, maximum permissible size of the actuator, sensor 
itor directly the actions of the joint. These ideas 


resolution, and the need to mon! ! 
are discussed in this chapter along with the workings of the sensors themselves. 
Although it is possible to utilize a robot without any external sensing what- 


soever, more and varied applications require such devices. Thus, in addition to 
the control of the robotic manipulator itself, certain more sophisticated tasks require 
that a variety of quantities be monitored at the gripper. The data gathered by 
sensors placed on or near the gripper can then be utilized by the robot’s controller 
to modify or adapt to a given situation. For example, if it is necessary to handle 
several different parts, some of which are rather fragile, it is important to measure 
the instantaneous gripping force being applied and adjust it to be sufficient to pick 


position. 
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up an object without crushing it. Ofcourse, the particular application wil] influe 
the type, construction, and cost of such sensors. me 
Currently, the “‘state of the art” in external sensing elements, techniques 
and materials, although fairly well advanced in some areas, is still in its infancy ne 
others. Many of the devices that have been developed are still only laborat , 
grade and are, therefore, not suitable for use in an industrial setting due to their 
inherent fragile nature or excessive cost. This chapter will not only discuss SOme 
of the external sensor measurement techniques, devices, and materials that are 
now available but will include a brief overview of some of the recent research 


results and trends in this area. 


9.2 NONOPTICAL-POSITION SENSORS 


In this section we discuss the operation and applications of simple internal state 
sensors that can be used to monitor joint position. Included are the potentiometer, 
synchro, resolver, and LVDT. It will be seen that some of these devices are 


inherently analog and some are digital in nature. 


5.2.1 Potentiometers 


The simplest device that can be used to measure position is the potentiometer or 
“pot.” Applied to robots, such devices can be made to monitor either angular 
position of a revolute joint or linear position of a prismatic joint. As shown in 
Figure 5.2.1, a pot can be constructed by winding a resistive element in a coil 
configuration. By applying a dc voltage V, across the entire resistance R, the 
voltage V4, is proportional to the linear or rotary distance of the sliding contact 
(or ‘“‘wiper’’) from reference point a. Mathematically, if the resistance of the coil 


between the wiper and the reference is r, then 


Vou = 2 Vi (5.2.1) 

For the pot to be a useful position sensor, it is important that the resistance 

r be linearly related to the angular distance traveled by the wiper shaft. Although 
it is possible to obtain pots that are nominally linear, there is always some deviation 
from linearity as shown in Figure 5.2.2. Generally, the nonlinearity of 4 ae 
(expressed as a percent) is defined as the maximum deviation € from the idea 


straight line compared to the full-scale output. That is, 
: (5.2.2) 





N.L. = 10 
: V 


max 


oo, . . : 
The inevitable presence of this nonlinearity in any pot makes its use 1m system 


. ; So . cal. 
where excellent accuracy measurement is required difficult and often impract! 
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+ 
Vout 
+ | - | 
Vs — eae 
(a) 
Vs 
+ | | - 
A RO —__ > | | 
a eee Figure 5.2.1. Wire wound potentiome- 
Wiper | ter (“pot”). Wiper makes physical 
<—__—_—__ d ———_> a contact with wires on the resistive coil. 
| Note: point ‘“‘a” corresponds to zero 
y of 1 output (i.e., zero resistance): (a) ro- 
* _ ~ tary—output proportional to 6; (b) lin- 
(b) ear—output proportional to “‘d.”’ 


Thus except in the case of robots where extreme accuracy is not needed (such as 
in educational devices), the pot is not generally used as a primary position- 
monitoring sensor. In a later section of this chapter, it will be seen, however, that 
it is possible to utilize this type of device as one of the components in a position- 
measuring scheme. 

Several other characteristics of a potentiometer limit its usefulness in high- 
accuracy position-measurement applications. The first has to do with the manner 
in which the device is constructed and hence how the voltage V,,, is sensed. In 
particular, the wiper must physically contact the coiled resistive element. The 
problem with this arrangement is that with time, the contact will deteriorate due 
to wear and dirt/corrosion buildup. (The latter is especially true in a typical factory 
environment where a robot will be used.) This will cause the measured output 
voltage to deviate from the true value in an unpredictable manner. The so-called 
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Figure 5.2.2. Output of a pot showing the theoretical linear and actual nonlinear 
characteristics as a function of angular position 6. 


“electrical noise” introduced by the poor contact will cause apparent position errors 
that cannot be tolerated in a system that requires high-position accuracy. 

A second problem with a wire-wound pot has to do with the smallest change 
in wiper position that can be sensed or its resolution. It is clear that with the wire- 
wound arrangement shown in Figure 5.2.1, a change in V,,, will occur only when 
the sliding contact moves from one coil loop to the adjacent one. Thus if the pot 
is constructed with N turns of resistive wire, the smallest voltage change that can 
be observed will be V,/N. The percent resolution can be defined as 


% resolution = 100 — = 100/N (5.2.3) 


Ss 


EXAMPLE 5.2.1 


A wire-wound potentiometer is to be used to measure angular position. A 

100-turn (i.e., 100 loops) resistive element is used and the wiper can rotale 

300"; 10 V dc is applied to the pot. Determine the resolution of the device: 
From the discussion above, the minimum voltage change will be 


10 
AV = 100 = 0.1 V/turn 


The % resolution is, therefore, 


% resolution = 100 (S) = 10 


— $$$ _ ns * * 
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Thin 
Resistive 
Film 


Figure 5.2.3. Thin film resistive pot. 
This device has much better resolution 
than the wire wound version. Also, 
contact “‘noise”’ problems are 

reduced. 





It is also observed that if the pot in Example 5.2.1 is connected directly to 
the shaft of a motor, for example, the position resolution will be 3° (300/100). 
Generally, in robot applications, this will not be good enough. That is, it will be 
necessary to “‘resolve” a smaller angular rotation. To accomplish this requires 
either a pot with more turns (for the same total angular rotation) or a modification 
of the motor drive and coupling scheme that permits more than 300° motor rotation 
in order to produce the same 300° of joint rotation. More will be said of the latter 
technique in a subsequent section. As far as the former “‘fix’’ is concerned, it may 
be possible to increase the number of turns of wire somewhat but, generally, not 
enough to improve the resolution significantly. 

What, then, can be done either to improve the resolution of the pot or to 
reduce the noise problem due to wiper contact problems? The answer to this 
question is seen in Figure 5.2.3, in which a pot made from a thin resistive film is 
shown. It should be clear to the reader that using such a scheme will significantly 
reduce the smallest angular change that can be resolved. Also, the resistive film/ 
wiper contact tends to be better “lubricated,” so that the problem with noise is 
reduced. As the sensing mechanism still depends on a physical contact between 
the resistive element and the wiper, this technique does not, however, eliminate 
all contact problems. 

The sensing devices described above produce a single-polarity voltage which 
is Sometimes undesirable. The scheme shown in Figure 5.2.4a overcomes this 
problem, as seen in Figure 5.2.4b. The reader should note that the output voltage 
now swings from —V, to + V, over the entire range of travel of the pot’s wiper. 

Despite the problems described above, it is possible to use pots to provide a 
limited amount of feedback control in robots where high positional resolution and 
accuracy are not essential to the operation and where a certain amount of jitter 
caused by noisy contacts is tolerable. An example is shown in Figure 5.2.5, where 
a circuit for obtaining teachable end or stop points 1s given. Here the position of 
the particular joint is monitored by a bipolar pot and is fed back to the op amp 
feeding the power amplifier stage. The desired or demand position is set by 
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(a) 
Angular Position of Wiper 


(b) 


Figure 5.2.4. (a) Scheme for obtaining a bipolar voltage from a pot; (b) theoretical transfer 
characteristic for the circuit in part (a). 


adjusting the voltage output of one of the input pots to the appropriate value (input 
position is thus proportional to voltage). Since the feedback is negative, the motor 
shaft driving the robot axis continues to rotate until the voltage across the position- 
sensing pot equals that coming from the demand-position pot. At that time, the 
robotic joint is at its programmed destination. 

The analog multiplexer (MUX) is used to permit a number of different inputs 
to be selected under digital control. For example, for the three shown in Figure 
5.2.5, a two-bit digital code could be used to select uniquely any one of the inputs. 
(If the fourth input was chosen, the joint would be commanded to go to its ‘‘home 
or reference positon.) Programming of a robot utilizing such a control _— 
would be accomplished by simply adjusting the input pots. A little thought eae 
convince the reader that moves consisting of multiple points can be obtained oo y 
by outputting a sequence of two-bit commands to the MUX (see Problem 9.2). 


5.2.2 Synchro 
t it requires 
r, a variety 


; er to produce an output. There are, howeve 
a physic er Peel a comands that avoid this difficulty. The a a or jnto 
of sensing devic hro, a rotary transducer that converts angular oe this 
discuss is the sy7c ng voltage into an angular displacement. peat ovations 
an ac voltage Or extensively during World War II, but technological gate 
device was — sition-sensing elements caused it to fall from 14 he 


ther po ain made 
that a saan advances in solid-state technology have ees robots: 
S, ee mon e 
— peers alternative for certain types of systems, a = aie three-phas 


ally, a synchro system is made up of a number of sep 
Normally, 
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Demand Sensing 
er ‘ 
Position 1 Digital input Po 
(2 bits) to select 
position 
Motor 
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Position 2 Analog 
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Demand 
Position 3 
90° 45° -V 
30° 


Demand Position 1=30° 
180° 0° Demand Position 2=45° 
Demand Position 3=300° 


270° 300° 


Figure 5.2.5. Teachable stop points using pots. The three pots are set to output voltages 
that will rotate the motor’s shaft 30, 45, or 300° (all with respect to zero degrees) depending 
on the digital input to the analog MUX. Other moves are also possible with this configuration 
including 15° (from 30 to 45°) or 270° (30 to 300°). 


components [e.g., the control transmitter (CX), control transformer (CT), and 
control differential transmitter (CDX)]. These elements all work on essentially 
the principle of the rotating transformer. Typically, two or three of the devices 
are used to measure angular position or the difference between this and a command 
position (i.e., the position error). For example, consider the two-element system 
shown in Figure 5.2.6. It is observed that an ac voltage is applied to the rotor of 
the CX and that the wye-configured stators of the CT and CX are connected in 
parallel. Using elementary transformer theory, it can be shown that the magnitude 
of the transformer rotor voltage Vour(t) is dependent on the relative angle 6 between 
the rotors of the CX and CT. In particular, this output voltage is 


Vout) = Vm Sin 8 sin Wacl (5.2.4) 
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Figure 5.2.6. A two-element (control transmitter CX and control transformer 
CT) synchro system used to measure angular displacement. 6@ is the relative angle 
between the rotors of CX and CT. 


where V,, and w,. are, respectively, the amplitude and radian frequency of the 
reference (or “Carrier”’) ac voltage. Those readers familiar with elementary com- 
munications theory will recognize that Eq. (5.2.4) represents an amplitude-moa- 


In the former case, however, the modulation is achieved through the application 
of another voltage Signal that varies with time. 

From Eq. (5.2.4) and Figure 5.2.6 it is seen that the output voltage has its 
maximum magnitude when the two rotors are at right angles to one another and 
that it is zero when they are at either parallel or antiparallel. As a consequence, 
the CT is sometimes referred to as a “null detector.” [t is important to understand 
that in practice, the null is never exactly zero when the two rotors line up because 
of nonlinearities and electrica] imbalances in the windings. These can produce 
“residual voltages” on the order of 60 mV (for a 115-V ac input). Due to the 
mathematical nature of a sine function, v,,,,(t) will be approximately linearly related 
to 6if —70°=6=<70°. Itis for this reason that where a linear 
output and angular position js import 
operating point of 6 = 0°. 

Ideally, the ac signals from the CX 
CT. However, physical di erences in th 


to produce a variable phase 
is illustrated in Figure 5.2.7. 
d slave rollers can be adjusted 


AC Carrier 
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Figure 5.2.7. An example of a servo using a three element synchro system. To maintain 
a uniform product (e.g., steel sheets), the slave roller’s speed w,(t) must be synchronized to 
that of the master, i.e., w,,(t). The CDX is used to provide the desired angular relationship 
between the master and slave. The output signal of the CT is the difference between this 
desired and the actual master-to-slave angles, i.e., the error, and is used to provide the slave 
motor drive signal. 


is illustrated in Figure 5.2.8. It is observed that the command or input (1.e,, the 
angle @,) will produce a command voltage from the CX. The CT will then produce 
an error voltage in accordance with Eq. (5.2.4), where 6 = 6, — 0. This error 
signal is amplified and causes the servomotor to rotate until @ is again zero. In 
such an application, the two-element synchro provides a rugged, reliable, and cost- 
effective method of monitoring position error. However, the reader can readily 
appreciate that because of the need to convert the command position into a physical 
angular rotation of the CX rotor, such a system is not always practical in applications 
requiring the interfacing to digital devices. Thus, as mentioned above, it is not 
surprising that with the advent of microprocessor-controlled systems, synchros were 
quickly discarded in favor of other position-sensing methods more compatible with 
digital systems. 

Recently, however, a number of advances in digital and hybrid technologies 
have produced a variety of devices that permit synchro systems to be easily inter- 
faced with digital systems. For example, the digital-to-synchro (D/S) converter 
shown in Figure 5.2.9 replaces the CX in the position servo of Figure Poe 2 
digital position command signal from a computer (e.g., the master) is transformed 
into a three-phase ac voltage by the D/S converter. (This voltage corresponds to 
that produced by the CX due to a physical rotation of 6,.) The CT once again 
acts as a position error sensor and the system behaves in a manner that is identical 
to that of the one in Figure 5.2.8. The use of the D/S converter produces a position 


servo that is part digital and part analog. 
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Figure 5.2.8. A synchro used in a position servo loop. The desired angular 
position is 6, whereas @, is the actual angular position of the motor shaft. [V, is 
the ac reference (carrier) voltage]. (Redrawn with permission of Walter Lewis, 
ILC Data Device Corp., Bohemia, NY. From the S ynchro Conversion Handbook, 


p. 10, 3rd printing, 1982.) 


In the next section we consider a device that is quite similar in operation to 
the synchro: the resolver. 


5.2.3 Resolvers 


The resolver is actually a form of synchro and for that reason is often called a 
‘synchro resolver.”’ One of the major differences between the two devices is that 
the stator and rotor windings of the resolver are displaced mechanically 90° to each 
other instead of 120° as is the case with the synchro. The most common form of 
resolver has a single rotor and two stator windings, as shown in Figure 5.2.10. 
With the rotor excited by an ac carrier voltage B sin w,.t, the two stator voltages 


become 
¥,.3(4) = V sin 6 sin w,.1 (5.2.5) 


v24(4) = V cos 6 sin w,.1 


(5.2.5b) 


where @ is the resolver shaft angle. It should be clear to the reader that such . 
device could, and often is, used in much the same way as the synchro CX to monito 


shaft angle. 
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Figure 5.2.9. The synchro control transmitter CX of the position servo shown in 
Fig. 5.2.8 is replaced by a D/S converter. This scheme permits the desired input 
0;, to be a digital quantity, 1.e., makes the system microprocessor compatible. 
(Redrawn with the permission of Walter Lewis, ILC Data Device Corp., Bohemia, 
NY. From the Synchro Conversion Handbook, p. 11, 3rd printing, 1982.) 


An alternative form of a resolver has two stator and two rotor windings. In 
actual use, the carrier voltage may be applied to any of these. For example, if 
the former is used as an input, the unused stator winding is normally shorted. The 
output voltages are identical to those given in Eqs. (5.2.5a) and (5.2.5b) and are 
monitored across the rotor windings. Alternatively, one rotor winding can be used 
as the input with the two stator windings being used as the outputs. 

To utilize a resolver in a servo system, it is usually necessary to employ two 
resolvers in much the same way as was done with the synchro system of Figure 
5.2.7. Figure 5.2.11 shows a resolver transmitter (RX) and resolver control trans- 
former (RT) in a simple position servo. Again, the reader should note that RX 
and RT are used to obtain the difference between the actual and desired angles 
(i.c., 8, — 6). It is important to understand that although angular position can 
be monitored using a single resolver [see Eqs. (S.2.5a) and (5.2.5b)], this is usually 
not done in servo-controlled devices because of the need to utilize an error signal 
to drive the system actuator. 

As in the case of the synchro, there has recently appeared a series of special- 
purpose chips that permit one of the elements of a resolver servo system to be 
eliminated. For example, the Analog Devices Solid-State Resolver Control Trans- 


Robotic Sensory Devices 


326 
R2 S4 
Rotor Stator 
R4 S2 
S1 
Stator 
S3 


Chap. 5 


Figure 5.2.10. Electrica] Circuit of a 
simple resolver. With an ac Carrier yo}, 
age input to the rotor, the Output Volt. 
age amplitude of the two stator Wind. 
ings will be dependent on the Sine or 
cosine of resolver shaft angle 6. (Re. 
drawn with permission of Analog De- 
vices, Inc., Norwood, MA. From 
Synchro and Resolver Conversion, 

Fig. 1-11, p. 7 © 1980, Memory Devices 
Ltd., Surrey, UK.) 


former (RSCT 1621) shown in Figure 5.2.12 can be used in place of an RT. 4, 
can be seen, a 14-bit digital representation of a command input ¢ and the analo; 
output of an RX, representing the actual angle 6, are input to the D/R converter 
The output of this device is then an analog voltage that is proportional to 9 — b 
This chip is a hybrid since it not only includes the digital and analog circuit. 
necessary to process the two input angles but also has on board the appropriate 


input and output transformers. 


The only significant difference between a D/R 


and a D/S converter is in the transformer configurations. 
A position servo utilizing such a chip is shown in Figure 5.2.13. Note that 
since the output of the D/R converter (or DRC) is an ac voltage, it is necessary 
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Figure 5.2.11, Resolver transmitter connected (0 a resolver control transformer 


(Redrawn 


with permission of Analog Devices, Inc. , Norwood, MA. From Synchro and Resolver Con- 
version, Fig. 1-13, p. 8, © 1980, Memory Devices, Ltd.,, Surrey, UK.) 


Sec. 5.2 Nonoptical-Position Sensors 327 


Resolver Solid-State Resolver Control Transformer 
Transmitted 
Cosine 
Multiplier 












RSCT 1621 










Quadrant 
Selection Error Signal 
Proportional to 


(6 - ) 


Sine 
Multiplier 


‘12 14 / 


Digital Input 


Figure 5.2.12. Resolver transmitter and RSCT 1621 Solid-State Resolver Control 
Transformer functional diagram. Use of this hybrid device permits elimination of 
separate input and output transformers. 6 is the measured or actual angular 
position and 9 is the desired angular position. (Redrawn with permission of Analog 
Devices, Inc., Norwood, MA. From Synchro and Resolver Conversion, Fig. 5-11, 
p. 110, © 1980 Memory Devices Ltd., Surrey, UK.) 


to use an ac amplifier, together with a phase-sensitive detector and integrator to 
obtain the appropriate drive signal to the servo amplifier. As in the case of a 
comparable synchro system, this servo is functionally a hybrid since the command 
signal is digital, whereas the monitored position (and the error) is analog in nature. 
(See Section 4.5.1 for further discussion of such a servo.) 

It was seen in Chapter 4 that it is often convenient, in the control systems 
used in robots, to have a digital representation of the actual angular position of 
either the actuator shaft or the joint itself. The tracking RDC shown in Figure 
5.2.14 accomplishes this. Here the RX is connected, either directly or through a 
gear train, to the shaft that is to be monitored. The converter then “tracks” the 
shaft angle outputting a digitized version of it. Thus it can be seen that the RDC 
takes the place of both an RT and an ADC. Unlike the ADC, however, the 
tracking RDC automatically performs a conversion whenever the input voltage 
from the RX changes by a threshold value, as determined by the resolution of the 
RDC. For example, if a 12-bit converter is used, a minimum angular change of 
0.088° (360/2!2) in the resolver shaft will initiate a conversion. Note that unlike 
many A/D converters, there is no need to trigger the R/D externally. 

Tracking synchro-to-digital (S/D) converters are also now available. The 
only difference between these devices and the RDC discussed above is that con- 
figuration of the input transformer on the chip is different since it must accept a 
three-phase rather than a two-phase voltage. Insofar as the user is concerned, 
however, the devices are identical. 

The reader may wonder whether there is an advantage to using a tracking 
R/D (or S/D) converter over a D/R (D/S) device since the decision seems to depend 
on the nature of the servo system configuration. However, with reference to Figure 
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Figure 5.2.13. A position servo that uses a D/R converter (i.e., RSCT 1621). An ac 
amplifier is used because the D/R output is an ac voltage. (Redrawn with permission of 
Analog Devices, Inc., Norwood, MA. From Synchro and Resolver Conversion, Fig. 5-12, 
p. 110, © 1980 Memory Devices, Ltd., Surrey, UK.) 


5.2.14, it is observed that the R/D converter has a velocity output. Available on 
many types of tracking R/Ds (or S/Ds), the analog voltage at this terminal represents 
the time rate of change of the input angle 6 or angular velocity. Thus if the RX 
is connected to the shaft of a robot joint actuator, the R/D will provide both angular 
position and velocity information. As noted in Section 4.2, the position servo 
used in a robot joint requires velocity information in order to provide the desired 
amount of damping. Since an R/D (or S/D) converter with velocity output provides 
this information, it seems to represent a possible alternative to a system that utilizes 
separate sensors to monitor position and velocity or where a digital representation 
of velocity is found from the digital position (see Section 4.5 .2). In fact, the 
velocity signal output of the R/D has better low-speed behavior and is more nearly 
linear than other velocity sensors and produces a better overall velocity signal than 
that derived from digital position sensors (e.g., an incremental encoder: see Section 
5.3.2); 
Application of such a device in a position servo used to control one axis of 
a robot is shown in Figure 5.2.15. Note that this system corresponds to a hybrid 
servo described in Section 4.5.1 since the angular position command and error 
signals are digital, whereas the inputs to the velocity loop (i.e., the command and 
actual velocity signals) are analog voltages. 
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Figure 5.2.14. A tracking resolver-to-digital converter. The RX senses the actual position 
§. The chip outputs a digitized version of this angle. The velocity is d6/dt and is an analog 
quantity. (Redrawn with permission of Analog Devices, Inc., Norwood, MA. From Syn- 
chro and Resolver Conversion, Fig. 3-3, p. 46, © 1980 Memory Devices, Ltd., Surrey, UK.) 


Theoretically, the development of R/D, S/D, D/R, and D/S chips to monitor 
angular position and velocity appears to make the resolver or synchro attractive 
for use in robotic systems. The rugged nature of the RX or CX is a particularly 
useful trait, and it is possible to obtain resolvers or synchros that have better angular 
resolution (i.e., the ability to sense smaller angular increments) than most other 
position sensors (e.g., incremental encoders or pots). However, there are a num- 
ber of reasons why these devices are not commonly used in robots today. The 
first is cost since the converter chip and RX (or CX) combination is usually sig- 
nificantly higher than that of an optical encoder package (including the associated 
electronics) for the same resolution. A second is the potential problem of elec- 
tromagnetic interference (EMI) due to the ac carrier signal. Although this problem 
can be overcome, careful shielding of certain critical subsystems of the robot con- 
troller is generally required to accomplish this and thus manufacturing costs may 
be increased. Finally, it is usually necessary to bring out a larger number of wires 
than with other position-monitoring techniques. This can be especially trouble- 
some with the moving joints of a robot. All things considered, however, it seems 
logical that if the overall cost of resolver/synchro systems is reduced, such devices 
will indeed be used in robot servo systems. * 





*In fact, this is already happening with a number of powerful RDC chips recently being introduced 
at prices that almost make the resolver system cost comparable to other more standard technologies 
(€.g., optical encoder). 
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Figure 5.2.15. Tracking R/D converter with velocity-output used in the position servo of a 
single robotic joint. This is a hybrid servo since the position information is digital whereas 
the velocity information is analog. (Redrawn with permission of Analog Devices, Inc., 
Norwood, MA. From Synchro and Resolver Conversion, Fig. 3-42, p. 73, © 1980 Memory 
Devices, Ltd., Surrey, UK. Redrawn with additions.) 


5.2.4 The Motornetics Resolver 


As mentioned in Chapter 4, a new type of motor with the trade name megatorqueé 
was introduced in the early 1980s. Capable of producing the extremely large 
torques required by direct-drive robots, the motor would have been less attractive 
in this application without the concurrent development of a high-resolution position 
sensor. Fortunately, such a sensor was developed by Motornetics Corporation 
1,2]. 

| As shown in Figure 5.2.16a in schematic cross section and in Figure 5.2.16b 
as it actually appears when fabricated, this novel reluctance-based type of resolver 
has annular ring geometry and consists of a single multipole toothed stator with 
windings together with a toothed rotor without windings. In effect, the primary 
and secondary windings are combined so that all of the active magnetic area 1s 
utilized. This causes the sensor’s accuracy to be improved and its signal level t0 
be increased. In addition, it needs only a total of four wires, which is an extremely 
important benefit in robot applications. 
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Figure 5.2.16. Motornetics resolver: (a) sketch showing current and flux paths. 

(Redrawn with permission of B. Powell and Motornetics Corp., a subsidiary of 
c : 

NSK. Santa Rosa. CA. From I.B, Cushing, “A New High Accuracy Angular 


Position Transducer” Proc. of Motor-Con, April, 1984, p. 284, Fig. 1.); (b) portion 


of actual device.) 


Although the stator and rotor of the Motornetics Resolver have the same 
number of teeth, tooth alignment varies in unison every third pole. This is ac- 
complished by changing the mechanical phasing of the teeth of each pole (with 
respect to the immediate neighbors on either side of any tooth) by one-third of a 
tooth pitch. The reader can easily verify that such is the case from Figure 5.2.16a. 
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Electrically, every third winding is connected in series so that the self- ang Mutual 
inductances (with respect to the other two phases) ¥ely cyclically. The cycle repeat 
each time the rotor moves one complete tooth pitch. In this way the Mechanica 
angle is equal to the electrical angle divided by the number of rotor teeth N + For 
example, if N = 150, the device can be thought of as behaving like a Standar 
resolver placed on the input side of a 150:1 speed reducer since the electrica] Signal 
will go through 150 cycles for each mechanical revolution. 

Although the Motornetics Resolver’s three-phase nature makes it more Close| 
resemble a synchro, electronic circuits are normally used to modify the signals , 
that more commonly available RDCs can be used to digitize the analog POSition 
information. A fairly inexpensive 10-bit RDC will produce an overall resolution 
of 153,600 (150 x 1024) ‘‘counts” per motor revolution. The corresponding num. 
ber for a 12-bit RDC is 614,400. In either case, this is considerably greater than 
the resolution generally used by industrial robots of the mid-1980s (e.g., in the 
order of 40,000 to 60,000 counts/rev). However, as robot resolution requirements 
increase, it is clear that this sensor will be a candidate in certain applications. 

It is important to understand that unlike the standard single-cycle resolvers 
described in the preceding section, the multiple-cycle device is an incremental 
position-sensing device rather than an absolute one. This means that when a robot 
utilizing such a sensor is powered up, the true position is unknown since the actual 
position is determined only within one cycle, but there is no way to know which 
cycle, of the possible N, is being sensed. The apparent difficulty is easily overcome 
by first causing the robot to execute a calibration procedure. For example, all 
joints may be driven (without regard to the position sensors’ outputs) until they 
encounter mechanical end stops. Then the motors are reversed, causing the robot 
joints to “back away”’ a specified number of ‘“‘counts’”’ from these end stops. All 
digital position counters are then zeroed. To obtain absolute position information, 
it is only necessary for the hardware to keep track of both the count and the cycle 
number, which can easily be done. 


5.2.5 The Inductosyn 


A device that is used extensively in numerically controlled machine tools is the 
Inductosyn, a registered trademark of Farrand Controls, Inc., which developed it. 
Acknowledged to be one of the most accurate means of measuring position, it Is 
capable of accuracies of 0.1 mil linear or 0.00042° rotary. 

In actual operation, the Inductosyn is quite similar to the resolver. Regard- 
less of whether the configuration is linear or rotary, there are always two mag- 
netically coupled components, one of which moves relative to the other. Fo! 
example, consider the linear Inductosyn shown in Figure 5.2.17. The fixed element 





? : ‘ e 
*Thus the resolver’s design uses ferromagnetic teeth to multiply the number of poles of a 
sensor without necessitating a large number of windings. This permits manufacturing costs to be ™ 
imized and reduces failures due to breaks in the coils. 
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Figure 5.2.17. Linear Inductosyn: (a) sketch of slider and scale with windings shown mag- 
nified. (Redrawn with permission of Farrand Controls, a division of Farrand Industries, 
Inc., Valhalla, NY.); (b) photo of actual device. (Courtesy of Farrand Controls, a division 
of Farrand Industries, Valhalla, NY.) 


is referred to as a scale and the moving element as a slider. Both of these are 
fabricated using printed-circuit technology, which is one of the major reasons for 
the high degree of accuracy that is achievable. A rectangular-wave copper track 
having a cyclical pitch of 0.1, 0.2, or 2 mm is normally bonded to the substrate 
material. The scale usually has one continuous track that may be many inches 
long (e.g., 10, 20, or longer). The slider, on the other hand, is about 4 in. long 
and consists of two separate tracks of the same pitch as the scale but separated 
from one another by 4 of a period (or 90°). The slider is mechanically able to 
travel over the entire length of the scale, the gap between these two elements being 
about 5 mils. (An electrostatic screen is placed between them to prevent accidental 
short circuits due to externally applied forces.) 
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As in the case of the resolver, an ac voltage v SiN ,<f iS applied to the Scale. 
Here, however, the carrier frequency (w,./27) is in the range 5 to 10 kHz, The 
Output at the two slider tracks is then 


(2X \ .. , 
Vin V sin 5 SIN Wace (S.2.6a) 


27X\ . 
Vo = VY cos 5 sin Wacl (5.2.6b) 


where X is the linear distance along the scale and S is the wave pitch. The 
amplitude of the sinusoidally varying input voltage is modulated spatially in much 
the same manner as the resolver [e.g., see Eqs. (5.2.5a) and (5.2.5b)]. Unlike 
the resolver, however, this spatial variation repeats every cycle of the scale track. 
Moreover, since Eqs. (5.2.6a) and (5.2.6b) represent the average voltage across a 
number of poles (i.e., cycles) of the scale, any variations in the pitch and/or con- 
ductor spacing are minimized, again contributing to the high degree of accuracy 
achievable with the device. 

In its rotary form, shown in Figure 5.2.18, the stator (surprisingly) corresponds 
to the slider of the linear Inductosyn. Two separate rectangular track waveforms 
are placed radially on a circular disk. Again there are separate sine and cosine 
tracks, which, because they alternate physically, permit most of the error due to 
spacing variations to be averaged out. As a consequence, the rotary Inductosyn 
is probably the most accurate means currently available for monitoring position in 
commercial machine tools. As mentioned previously, typical accuracies are in the 
order of +0.42 millidegrees. Note that although laser devices are capable of giving 
considerably higher accuracies, their excessive cost makes them unattractive for 
this type of application. 

The rotor of the rotary Inductosyn corresponds to the scale of the linear 
device in that it has a single, continuous, and almost rectangular printed track. 
Typically, there are anywhere from 128 to 1024 cycles (or 256 to 2048 “poles”’) 00 
the disk. Because of the rotary configuration, however, the ac input voltage 1s 
applied to the rotor using brushes and slip rings. (A brushless configuration 1s 
also possible.) The output voltage of the device is monitored across the stator 
and has the same form as that shown in Eqs. (5.2.6a) and (5.2.6b) except that 
(277X/S) is replaced by N6/2, where N is the number of poles of the rotor, and 0 
is the angle of rotation of the rotor with respect to the stator. 

In actual operation, either form of Inductosyn can be used like a resolve! 
For example, one Inductosyn can act like a transmitter (RX) and the other like @ 
receiver (RC) in a simple position servo. Alternatively, a resolver can be used 2 
the RX and the Inductosyn as the RC. The advantage of the latter approach, 
however, is that one complete rotation of the resolver due to a position comma 
signal will produce only a single cycle motion of the Inductosyn. Thus dependine 
on the resolution of the latter device (i.e., the number of cycles per unit length 
over 360°), use of the Inductosyn would permit positioning of a machine tool to 
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Figure 5.2.18. Rotary Inductosyn®. The stator corresponds to the slider of the linear 


Inductosyn®. The ac carrier voltage is applied to the rotor. (Courtesy of Farrand Controls. 
a division of Farrand Industries, Valhalla, NY.) 


close tolerances. For example, a 1-mil linear resolution would not be unreasonable 
at all. 

The configuration described above would be potentially attractive for use in 
either prismatic or rotary joints of robots. However, gears or harmonic drives 
would still be required to obtain the torque multiplication from actuator to output. 
Thus the added cost of the Inductosyn, together with the additional electronics 
needed to digitize its output signals, would probably make the Inductosyn less 
attractive than other position-monitoring sensors. However, if extremely high 
accuracies are required in the future, this device may someday be useful in the 
design of robots. 


5.2.6 Linear Variable Differential Transformers 


Another device that is both extremely rugged and capable of accurate position 
determination is the linear variable differential transformer (LVDT; see Figure 
5.2.19). It is observed from this figure that the LVDT consists of two parts, one 
of which is movable and the other fixed. This electromechanical transducer is 
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Figure 5.2.19. A linear variable differential transformer (LVDT) showing the 
single pnmary and the two sets of secondary coils. The magnetic core is generally 
the moving element of this sensor. (Redrawn with permission of Schaevitz En- 
gineering, Pennsauken, NJ.) 


capable of producing a voltage output that is proportional to the displacement of 
the movable member relative to the fixed one. Units having sensitivities on the 
order of 1 mV/mil with full-scale ranges of +25 mils to several inches are available. 
Because LVDTs are analog devices, they essentially have a resolution that is limited 
only by the external monitoring device (e.g., a voltmeter). 

A common design of the LVDT has three equally spaced coils (L,, L,,, and 
Lo) on a cylindrical coil form (see Figure 5.2.19). This is usually the stationary 
element. A rod-shaped magnetic core is also positioned axially inside the coil 
assembly and is free to slide back and forth. The purpose of this moving element 
is to provide a magnetic path for the flux linking the three coils. 

To understand the operation of the LVDT, we consider the equivalent elec- 
trical circuit of the device shown in Figure 5.2.20. As can be seen, an ac voltage 
is applied to L,, the primary side of the coil structure (this corresponds to the 
center coil in Figure 5.2.19). Since L,, and L,, on the secondary side are connected 
in series opposing (note the position of the dots on the windings), Vour(t) will be 
zero if the coupling between the primary and each of the secondary windings |S 
the same (i.e., the voltage induced in these coils will be the same). A little thought 
should convince the reader that this condition will exist when the magnetic core !5 
positioned exactly in the center of the coil assembly. 

If, however, the core is moved away from the central position, the coupling 
between L,, and L, will differ from that of L., and L,. For example, the forme 
will increase, whereas the latter will decrease. Consequently, the voltage induce 
in L,, and L,, will increase and decrease, respectively, with respect to their omg? 
core values. Thus v,,,(t) will be nonzero. With reference to Figure 5.2.17, ' 
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Figure 5.2.20. Electrical circuit of an LVDT showing the magnetic core. The 
secondary coils are connected in series opposing so that when the core is at or near 
the center of the LVDT 2,,,(¢) is zero. The signal conditioner is used to ‘“de- 
modulate” ¥,,,(t) and produces a dc voltage that is proportional to the core’s linear 
distance away from the null (center) position. (Redrawn with permission of Schae- 
vitz Engineering, Pennsauken, NJ.) 


should be apparent that as the core is moved farther away from the central position, 
the coupling between the primary and one secondary coil will increase. There will 
be a corresponding decrease in the coupling between the primary and the other 
secondary winding. Thus the magnitude of v,,,(¢) will be related to the linear 
displacement of the magnetic core. With proper design it is possible to make this 
output voltage linearly proportional to the displacement as shown in Figure 5.2.21. 
In normal operation, the object whose position is desired is attached to the rod- 
shaped magnetic core. A voltage that is proportional to the motion of the object 
results. 

The signal conditioner shown in Figure 5.2.20 performs a number of functions. 
The first and perhaps the most obvious one is to convert the ac voltage v,,,(¢) into 
a dc voltage Vy,. See Figure 5.2.21, where this was implied. The second task 
required of the device is that of determining the phase of 2,,,(¢) with respect to 
v;,(t). This is necessary so that positive and negative displacements can be sensed. 

A final operation performed by the signal conditioner is demodulation. The 
ac voltage applied to L, may be thought of as a carrier signal. As the magnetic 
core is moved dynamically, the carrier is, in effect, modulated by the motion 
waveform f(t). To be able to sense such dynamic behavior, the signal conditioner 
must eliminate the high-frequency ac component, that is, it must demodulate v,,,(4), 
thereby producing a voltage V,. that is proportional to the physical motion wave- 
form f(t). It should be noted that carrier frequencies of 2 to 20 kHz are typical. 
Motions with a frequency content of approximately 1/10 of this value can be mon- 
itored (i.e., 200 to 2000 Hz). 

LVDTs are often used to sense position where pure linear motion is performed 
(e.g., in a variety of machine tools, such as lathes). Rotary motion can be sensed 
with an RVDT (where R stands for ‘‘rotary’’), a device that works on the same 
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Figure 5.2.21. Output of an LVDT signal conditioner as a function of the core 
position x. For |x| = X,,,, the characteristic is extremely linear. Outside of this 
range, however, linearity suffers. (Redrawn with permission of Schaevitz Engi- 
neering Pennsauken, NJ.) 


principle as the LVDT but has a rotational configuration. When it comes to robots, 
however, neither device has been much used because of a number of problems. 
The first difficulty with the LVDT in a robot application is that it is necessary 
to operate the device about its center point. Such an alignment is often quite 
difficult to perform and could create major manufacturing problems, thereby in- 
creasing costs. Difficulties with calibration of the robot on power-up could also 
be encountered. A second and associated problem with the LVDT is that the 
center or “null’’ position has a tendency to drift with time and temperature. Unless 
this is prevented (by the use of appropriate temperature compensation) a change 
in the robot’s calibration would result, a totally unacceptable occurrence in most 
manufacturing environments. Possibly the major difficulty with using an LVDT 
and/or RVDT as a position sensor is that the joints of most robots do not mové 
in pure straight lines or circular arcs. Motion is normally a complex combination 
of these trajectories. Asa result, it is quite difficult, if not impossible, to configure 
the LVDT/RVDT so that the magnetic core is always collinear with the axis of the 
coils. Note that binding and probable damage to the unit will result if collinean'y 
is not maintained. Finally, the RVDT has one additional limitation that — 
its application to robots problematical. That is, it can only sense rotary mee 
of approximately +60". Since most robotic axes are required to move more 
120°, this is most certainly a severe restriction. - 
Even if these difficulties were to be Overcome, the fact that the LVDT Se 
analog device would make it inconvenient to utilize the device in a microproces® 
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controlled servosystem. In addition, the cost of the sensor, signal-conditioning 
circuitry, and A/D converter would be, no doubt, significantly higher than that of 
an equivalent optical incremental encoder and its circuitry. Thus it seems likely 
that despite its good resolution capabilities, the LVDT will not soon be used on 
robots themselves as an internal position sensor. It seems more realistic to expect 
that such devices will be utilized in equipment that is used in conjunction with a 
robot (e.g., in parts presentation). Indeed, this is already a fact in some instances. 


5.3 OPTICAL POSITION SENSORS 


As we have seen, the sensors discussed in the previous sections can theoretically 
be used to determine the position of a robotic joint. However, for one or more 
practical reasons, doing so is either not possible or often difficult and/or incon- 
venient. Another class of sensor, utilizing optical hardware and techniques, can 
quite frequently be used to perform the position determination task with relative 
ease and surprising accuracy. We now discuss such devices and their application 


to robotics. 


5.3.1 Opto-Interrupters 


It will be recalled that point-to-point-type robots require only that the beginning 
and end points be accurately determined (see Section 1.3.3.1). The actual path 
between these points is not important, and hence little or no position information 
is utilized by the robot’s control system except at the trajectory endpoint. The 
actuators drive the joints of the robot until the final position is sensed, at which 
time the actuating signals are removed. In effect, an open-loop control scheme 
is used. “Programming” is accomplished by moving the endpoint sensors to dif- 


ferent locations. 


It might appear that a simple mechanical switch (or micro switch) is an ideal 


device for this application. However, because of the need to interface the switch 
with a microprocessor, the inevitable contact bounce problem and the limited life 
expectancy make this approach relatively impractical for commercial robots. (It 


is used in educational-type robots, however. ) | - 
sed to produce the required ability to sense 


An optical technique can be u | : 
“end of travel” without the problems associated with mechanical switches. Called 
n is quite easily understood. Consider the arrange- 


an opto-interrupter, its operatio ; 
P P nt disk with at least one dark sector Is 


ment shown in Figure 5.3.1. A transpare 
placed between a light emitter (e.g., an LED) and a light receiver or sensor (¢.g., 


a phototransistor). Light will reach the receiver until rotation of the disk causes 
the “black flag” to block it. A binary or “on-off” signal can be generated and 
used to sense the endpoint of travel. For example, the output (i.e., the collector) 
of the phototransistor will be Jow as long as light impinges on the transistor’s base. 
On the other hand, the collector voltage will be high when there 1s no light. 


340 Robotic Sensory Devices Chap ; 


Light 
Emitter 


Receiver or 
Light Sensor 


Black 
Flag 





Figure 5.3.1. Simple opto-interrupter 
showing light emitter-receiver assembly 
and disk with ‘‘black flag.” 


Disk 


The block diagram of a simple electronic circuit that makes use of such a 
sensor to drive a robot axis to the end of travel is shown in Figure 5.3.2. Here 
the system is actuated by momentarily closing the start switch. The motor will 
continue to rotate until the black flag on the disk prevents light from reaching the 
light sensor. When this occurs, the motor voltage is turned off and the axis coasts 
to a stop. (If desired, additional circuitry can be added to produce dynamic braking, 
thereby stopping the motor much more quickly. ) 

A possible realization of the logic and sensor electronics is shown in Figure 
53.3. The waveforms of the digital signals S,, S,, and S; are shown in Figure 
5.3.4. To understand the operation of this circuit, recall that the output of a 
NAND gate will be low (i.e., 0 volts or “logical zero”) only when both inputs (S; 
and S, in this instance) are high (i.e., “logical 1” or for TTL logic circuits, 5 V). 
Any other combination of input signals will cause the output of the NAND gate 
to be high. Thus if the black flag on the disk is initially placed in the slot of the 


Disk 


Drive To Robot Joint 
Start iL 


On/Off Signal 


—_ 


Figure 5.3.2. Block diagram of a simple unidirectional motor control circuit. The 
motor begins to rotate when the switch is closed. 
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opto-interrupter, the collector of the phototransistor will be about 5 V, so that S, 
will be high. In addition, if the one-shot and debounce circuit is designed so that 
its output is normally high and goes low only when the one-shot is triggered by 
the start switch being grounded, S, will normally be high also. Therefore, the 
signal to the motor drive circuitry is Jow and the motor does not turn. 

As seen in Figure 5.3.4, when the start switch is depressed, S, goes low, which 
in turn causes S$; to go high. The motor begins to rotate and will continue to do 
so until the black flag again interrupts the light, reaching the base of the photo- 
transistor. 

It is important to note that this simple circuit permits only unidirectional 
rotation of the motor. ‘Thus if it were used to actuate an axis of a simple robot, 
the manipulator would be limited to motion in one direction only. More complex 
circuitry would be required to produce bidirectional motion. In addition, as shown 
in this example, such a robot would be quite limited since there would be only a 
single endpoint. More endpoints could be obtained simply by utilizing more than 
one flag placed at appropriate places on the disk. In fact, “programming” such 


Ss; 1 
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S. 1 
Switch 
0 Depressed 
SS; 1 
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Motor Off —>|<_____— Motor On ——————>}—— Motor Off =| 


Figure 5.3.4, Timing diagram for the digital signals associated with the sensor 
and logic circuit of Fig. os SB 
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a robot axis would consist of producing a special disk with the correct number of 
flags at the proper locations (see Problem S11). 


9.3.2 Optical Encoders 


One of the most widely used position sensors is the optical encoder. Capable of 
resolutions that are more than adequate for robotic applications, these noncontact 
sensory devices come in two distinct classes: (1) absolute and (2) incremental. |p, 
the former case, the encoder is able to give the actual linear or rotational position 
even if power has just been applied to the electromechanical system using the 
sensor. Thus a robot joint equipped with an absolute encoder will not require 
any calibration cycle since the controller will immediately, upon power-up, know 
the actual joint position. 

This is not so in the case of the incremental encoder, however. Such a sensor 
only provides positional information relative to some reference point. A robot 
utilizing an incremental encoder must, therefore, first execute a calibration se- 
quence before “‘true”’ positional information can be obtained. The discussion at 
the end of Section 5.2.4 is pertinent in this context. 

Although either linear or rotary encoders for both of the foregoing classes 
are available, the rotary device is almost exclusively used in robotic applications. 
One of the most important reasons for this is that revolute joints far outnumber 
prismatic ones in robots currently being manufactured. Even for joints that move 
in a linear fashion, as in the case of a spherical coordinate manipulator, the linear 
encoder is normally much more costly, and so rotary encoders are still employed. 
Therefore we restrict the discussion to the latter type, although much of what is 
said will apply directly to the linear sensor. 


5.3.2.1 Rotary absolute encoders 


As mentioned above, the absolute encoder is capable of giving the correct 
rotary position at all times even after power-up has occurred. The device produces 
a separate and unique coded word for each shaft position, and unlike the incre- 
mental encoder, every reading is independent of the preceding one. A major 
advantage of the absolute encoder is that even if system power is accidentally lost 
(due to a power outage or relay trip, for example) the device will ‘“‘cemember 
where it is and will report this to the system as soon as power is restored. Cali- 
bration of machines using this type of encoder is, therefore, maintained even if the 
position of the rotating member is moved when the power is off. 

Absolute encoders usually consist of three major elements: 


1. A multiple-track (or channel) light source 
2. A multiple-channel light receiver 
3. A multiple-track rotary disk 


Normally, light emanating from a linear, N-element light source (e.g.> LEDs) 
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is made to pass at right angles through the disk and is received (or collected) by 
a corresponding linear array of N light sensors (e.g., phototransistors) mounted 
on the opposite side of the disk (see Figure 5.3.5). The disk is divided into 
circumferential tracks and radial sectors. Absolute rotational information is ob- 
tained by utilizing one of several possible code formats. For example, Figure 5.3.6 
shows a four-track 16-sector pure binary-coded disk. Other coding schemes that 
can be used include binary-coded decimal (BCD) and Gray code. It can be seen 
from Figure 5.3.6 that the resolution of the disk is 22.5° (360/16) since one complete 
disk revolution is 360° and there are 16 sectors. If the shaded areas are assumed 
to represent a binary “1” and the clear areas a binary “0,” the outputs of each of 
the four light sensors will represent a 4-bit sequence of ones and zeros. For the 
binary code used in Figure 5.3.6, the decimal equivalent of this number is the 
actual sector number. As an example, if sector 11 is in the region of the LEDs, 
the output of the photo transistors will be 1011 or decimal 11. It is clear from this 
discussion that the absolute disk position is known simply by reading the photo- 
detector outputs. 

In practice, it is possible to produce absolute encoders with up to 13 separate 
channels (i.e., 13 bits) which means that resolutions of up to 360/2'° = 0.044° are 
possible for a single complete rotation of the disk. Often, however, it is necessary 
for the device being monitored by the encoder to undergo many rotations. Since 
it is clear that the coded binary sequence repeats for each complete disk cycle, 
something else is needed. In this case it is possible to use a second disk placed 
on the same shaft as the first but geared down so that a complete revolution of 
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Figure 5.3.6. A four-track, sixteen-sec- 
tor pure binary-coded disk used in an 
absolute encoder. (Redrawn with per- 
mission of Dynamics Research Corp., 
Wilmington, MA. From ‘Techniques 
for Digitizing Rotary and Linear Mo- 
tion,” Fig. 3-1, p. 3-2, 1976.) 





the first moves the second only a distance of one sector. The first one is used for 
absolute positional information for any single shaft revolution, whereas the second 
disk gives the actual rotation number. 

Although their ability to “remember”? position is an extremely attractive 
feature for robot applications, absolute encoders are generally not used because 
of their excessive cost. For example, a 10-bit device can run several hundred 
dollars. A comparable incremental encoder, on the other hand, can be purchased 
for about $80 to $100. It is, therefore, not Surprising that most robots utilize 
incremental devices, which we now discuss in some detail. 


5.3.2.2 Optical incremental encoders 


As mentioned above, optical incremental encoders are widely used to monito! 
joint position on robots. In addition, they are the sensor of choice in a variety ° 
machine tools, including lathes, x-y tables, and electronic chip wire and hybrid die 
bonders. ‘The major reason is that they are capable of producing excellent resOo- 
lution at a significantly lower cost than a comparable absolute device. Howevel 
absolute position information can be obtained only by first having the robot OF 
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other machine tool perform a calibration operation. This is usually not considered 
to be a major disadvantage, since such an operation generally has to be executed 
only after power has been applied. It is important to understand that if power is 
accidentally lost during an operation, calibration must be performed again since 
the incremental encoder has no ‘“‘memory.” 

Just as in the case of the absolute device, the incremental encoder in its 
simplest form consists of a disk, an LED light source, and a corresponding set of 
light receivers (e.g., phototransistors). However, there are significant differences 
between the two. For example, there are usually only a single LED and four 
photodetectors. Also, the thin circulator disk (usually made of glass, Mylar, or 
metal) contains a single track consisting of N radial lines, as shown in Figure 5.3.7. 
The resolution of an encoder containing such a disk is normally defined as the 
number of lines, N. This implies that the encoder can resolve an angular position 
equal to 360°/N. Typically, encoders with resolutions of 100, 128, 200, 256, 500, 
512, 1000, 1024, 2000, and 2048 lines are available, meaning that angular resolutions 
ranging from 3.6° down to 0.175° are achievable. Generally, in robot applications, 
200- to 1000-line disks are quite adequate, even where it is necessary to position 
a part or tool to within +1 or 2 mils. We will shortly see that it is possible to 
increase this resolution electronically. However, before discussing this, let us 
describe how the incremental encoder produces positional information. 





Figure 5.3.7. An incremental encoder disk having 200 radial lines. A resolution 
of 1.8° is possible with such a device. (Courtesy of Dynamics Research Corp., 
Wilmington, MA.) 
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If the encoder disk is mounted on a rotating shaft (e.g., of a Servomotor 
shown in Figure 5.3.5), then as the disk turns, light to the photodetectors will be 
interrupted by any line on the disk that passes in front of the LED source, jy can 
be shown that the detector’s output will be a waveform that is 4PProximately 
sinusoidal. Often, a comparator is used to convert these signals to TTL Pulses 
thereby making them more suitable for digital systems. There are two problems 
with this arrangement. The first is that although a single photodetector will pro. 
duce a sequence of N TTL pulses per revolution, it should be clear that it will be 
impossible to determine the direction of rotation of the disk. A second difficulty 
arises due to variation or drift in light source and/or ambient light intensity. Since 
a comparator is used for TTL conversion, the width of the pulses will be quite 
sensitive to the amount of light collected by the detector (see Problem 5.12). This 
is an undesirable condition, especially in cases where the disk is spinning at a high 
rate of speed (e.g., more than 5000 rpm; see Problem 5.13). 

Both of these problems can be overcome by employing multiple light sensors. 
For example, a second photodetector separated from the first by 90° (electrical) 
will produce a second, or B output channel which is identical to the first, or A 
channel, except that it yields TTL signals approximately 90° out of phase with the 
original ones. Clockwise or counterclockwise rotation of a motor shaft can be 
determined simply by noting whether A leads or lags B (see Figure 5.3.8). 

The solution of the light-variation problem requires the use of additional 
photosensors. To understand this, consider the single-channel encoder (with only 
a small, magnified section of the disk indicated) shown in Figure 5.3.9. Here we 
have placed a stationary plate or reticle in front of the light sensor. This component 
consists of a number of optical “‘slits’’ (i.e., lines) and is used to direct light from 
about 20 lines on the encoder disk to the single photodetector. An overall im- 


A 
Channel Jf LE | LJ |] sf 
Output 


B 


LJ ~-L J Lf LL Channel 
Output 


(a) 


A 
Channel 
Output 
B 
| LJ LJ Ly Channel 
Output 


(b) 


Figure 5.3.8, TTL outputs of the A and B channels of an incremental encoder: 
(a) A leads B when clockwise rotation occurs; (b) A lags B when counterclockwise 


rotation occurs. 
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Figure 5.3.9. Section of a single chan- 
nel encloder. (Redrawn with permis- 
sion of Dynamics Research Corp., Wil- 
mington, MA. From “Techniques for 
Digitizing Rotary and Linear Motion,” 
Fig 4-1, p. 4-2, 1976.) 


provement in performance is realized by reducing the encoder’s sensitivity to both 
dirt and variation in line placement. 

In actual operation, when the disk is rotating, the photosensor voltage output 
will vary theoretically in a triangular fashion, as shown in Figure 5.3.10. Actually, 
the waveform is more nearly sinusoidal, primarily due to the finite line widths in 
the shutter assembly (i.e., the disk and reticle). The maximum sensor output 
Voltage Ea, is proportional to the intensity of the- LED. The minimum voltage 
Emin is not zero because light cannot be fully collimated by the shutter ie. there 
Is always some light leakage). This value can be minimized, however, by reducing 
the clearance between the shutter and the light source (e.g., a 1- to 10-mil gap is 
'ypical). It is desirable to do this because the usable component of the sensor * 
°utput is the peak-to-peak value Ey. . 

Ifa anaes is used to digitize the sensor output signal, a TTL pulse = 

© generated each time the voltage passes above the average value Fave. This wi 
theoretically produce a train of pulses with a 50% duty cycle provided that the 
disk js rotating at a constant velocity (see Figure 5.3.11a). However, if Fy. drifts 
“ue to LED and/or ambient light intensity variation or photodetector sensitivity 
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Figure 5.3.10. Output voltage of the sensor in Fig. 5.3.9 as the encoder disk 
moves relative to the reticle. (Courtesy of Dynamics Research Corp., Wilmington, 
MA. From ‘Techniques for Digitizing Rotary and Linear Motion,” Fig. 4-2, p. 
4-3, 1976.) 


changes (caused by elevated temperature or high-frequency operation), the pulses 
will no longer have a 50% duty cycle, as shown in Figure 5.3.11b. Although at 
low speeds this is not a problem, high-speed applications will cause the pulses to 
be so narrow as to produce sensing errors (i.e., pulses may be missed). 

This problem can be overcome by employing a second sensor (and reticle) 
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Figure 5.3.12. Use of two sensors with the same light source to reduce the variation 
in the average value of the encoder’s output, E,,.. (Redrawn with permission of 
Dynamics Research Corp., Wilmington, MA. From ‘Techniques for Digitizing 
Rotary and Linear Motion,” Fig 4-4, p. 4-5, 1976.) 


Placed 180° out of phase with the first, as shown in Figure 5.3.12. Note that the 
Same light source is used to illuminate both sensors. If the outputs of the two 
Photodetectors are connected in “‘push-pull” so that the two signals are subtracted, 
4 triangular waveform centered about zero and having approximately twice the 
peak-to-peak amplitude of either signal will be generated (see Figure 5.3.13). In 
Practice, differences in the two sensors cause the average value to differ somewhat 
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Figure 5.3.13. Push-pull output from two sensors. This arrangement significantly 
reduces the effect of average value drift on the TTL duty cycle. (Redrawn with 
permission of Dynamics Research Corp., Wilmington MA. From ‘‘Techniques 
for Digitizing Rotary and Linear Motion,” Fig 4-6, p. 4-6, 1976. 


from zero. However, this is a second-order effect and can easily be offset with a 
bias voltage applied directly to the difference amplifier. 

The push-pull configuration has a number of advantages over a single sensor 
device. First and most important, the optical encoder is much less sensitive to 
variations in the average value of the photodetector output since the light sensors 
will be equally affected. As a direct consequence, the interpulse spacing variation 
(at constant velocity) is reduced to about one-half that found for a single senso! 
unit for the same drift in average light intensity. In addition, temperature and/ot 
frequency effects are minimized because, once again, both sensors are affected to 
the same degree. | 

As mentioned above, the single sensor encoder cannot give any information 
about the direction of rotation. A little thought should convince the reader that 
the use of a second photodetector placed 180° out of phase with the first one 40° 
not alter this situation. The encoder obtained is stil] a single-channel device. 
determine direction, a second set of photosensors, placed 90° out of phase was 
the first set, must be used as shown in Figure 5.3.14. Here the (push-pull) outp’ 
of the first set becomes the A channel, whereas that of the second is channel ?: 
A typical two-channel output is shown in Figure 5.3.15. Using the same convent 
as in Figure 5.3.8, the situation in Figure 5.3.15 would represent clockwisé 
disk rotation. Note, however, that such an assignment is arbitrary, and there’? 


jon 
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Figure 5.3.14. Two sets of sensors, placed 90° apart, are us 
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ed to determine the direction 


one could just as easily consider “‘A leading B” to be a counterclockwise (CCW) 
rotation. Which definition is used is unimportant, but consistency must be main- 


tained. 


5 3.2.3 Increasing incremental encoder resolution electronically 


Besides permitting the determination of (rotational) direction, the addition 
of a second channel to an optical incremental encoder has an added important 
t: increased resolution. One would normally expect that a disk containing 
60°/N. However, it is possible to utilize the 
Is to reduce this number electronically by a 
ctions as high as 20 have been obtained!). 
d quadrupling the resolution of an optical 


benefi 
N lines would have a resolution of 3 


information contained in both channe 
factor of 2, 4, or even more (in fact, redu 
We now present methods for doubling an 
incremental encoder. 


Double Resolution. 
produce a “x2” (‘“‘times two 
lines on the encoder. The explanatio 


(see Problem 5.15). | a 
Another way to implement a X 2 circuit that can detect direction at the same 


time is with a ROM used in a feedback configuration (see Figure 5.3.16). For the 
16-by-4-bit ROM, the two most significant output (i.e., data) bits, D, and D3, are 
fed back to the two most significant address lines, A, and A;, respectively. The 
two least significant data bits are sent to the CU (count up) and CD (count down) 
inputs of an up/down counter. To understand how this circuit works, assume that 
a clockwise rotation produces a pulse on the CU line and a counterclockwise 


A single, two-input Exclusive OR gate can be used to 
”) circuit, thereby doubling the effective number of 
n of this is left as an exercise for the reader 
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Figure 5.3.15. Two channel, incremental encoder outputs: (a) “‘raw,”’ triangular signals; (b) 
digital signals. A channel leads B. [Part (a) redrawn with permission of Dynamics Research 
Corp., Wilmington, MA. From “Techniques for Digitizing Rotary and Linear Motion,” 
Fig. 4-7, p. 4-7, 1976.] 





(b) 


rotation, a corresponding pulse on the CD line. Furthermore, suppose that 4 
portion of the ROM data table is as shown in Table 5.3.1. 

First assume that the encoder disk is at rest and that the A channel is out- 
putting a 1 and the B channel a 0 so that Ay = 1 and A, = 0. It can be seen 
that for row I of the ROM data table, the data at address 1010 is 0010. This is 2 
stable situation since D, and D, are identical to A, and A,, respectively. Moreovel; 
both the CU and CD lines are 0, so that the up/down counter is not changing: 
Now let the disk begin to move in a clockwise manner. When A, = 1, the RO 
address becomes 1110. If the data stored at this location are those shown on row 
II of the table, we will have an unstable situation since D, = 1 (i.e., the address 
‘wants to be” 1111). Asa result, the system will rapidly move to row III. it 
ever, before this can occur, the count-up line will have gone high for a short pen 
of time, causing one to be added to the count. The reader can easily verify that 
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Figure 5.3.16. A circuit used to double the resolution of an incremental encoder 
and sense direction of rotation. A 16-by-4 bit ROM and feedback are utilized. 


once row III is reached, a stable situation is again present and no further counts 
or shifts in addresses will occur unless the encoder disk continues to rotate. 

Using the same logic as above, it can be seen that starting at row III in the 
data table and rotating the encoder disk CCW will produce a short-duration pulse 
onthe CD line. Row IV will represent an unstable situation and cause the address 
to change rapidly from 1011 to 1010 (row V). It is possible to complete the 
remaining 12 data entries for the ROM, so that any CW or CCW rotation of the 
disk produces an appropriate up or down count (see Problem 5.16). 


Quadrupie Resolution. The X2 circuits just described effectively recognized 
pulses from both the A and B channels of the encoder. The reader may have 
already noted, however, that for each line on the disk, there are actually four edges 
(or transitions) produced (see Figure 5.3.8, for example). This fact leads to the 
conclusion that simply by counting these edges, a fourfold increase in resolution 
should be possible. A circuit that effectively does that is shown in Figure 5.3.17. 

To understand the operation of this circuit, refer to the timing diagram for 
CW motion of the disk shown in Figure 5.3.18. Suppose that the 16-bit counter 
(realized with four 4-bit binary up/down counter chips that respond to negative 
edges on the CU and CD inputs) is initially cleared (i.e., its count is 0, so the 
LSB + 2 through the MSB are low). It can be seen from Figure 5.3.17 that the 
LSB of the count is obtained by exclusively OR’ing the A and B channel signals, 


TABLE 5.3.1 ROM DATA TABLE 
Ao A, A, A; Do D, D, D, Comment 


I 1 0 1 0 0 0 1 0 Stable 
II 1 1 1 0 1 0 1 1 Unstable 

Ill 1 1 1 1 0 0 1 l Stable 
IV 1 0 1 1 0 | 1 0 Unstable 

V 1 0 1 0 0 ) 1 0 Stable 
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Figure 5.3.17. Possible circuit for increasing the encoder resolution by a factor of 4. Note 


that either a count-down or a count-up pulse will be generated depending on whether A 
leads or lags B. 


whereas the LSB + 1 is just the A channel information itself. In addition, it is 
observed that a count-down pulse is generated for each encoder line sensed. (See 
10 + B in Figure 5.3.18). 

With respect to Figure 5.3.18, it can be seen that just before fo, the position 
count is zero since A and B are both low and the most significant 14 bits have been 
assumed to be zero. On the leading edge of the first pulse on the A channel (at 
to), both the LSB and LSB + 1 become 1 and because a count-down pulse is also 
generated, the most significant 14 bits also change from 0 to 1. The count in 
hexadecimal has changed from 0000 to FFFF. The first B-channel positive edge 
(at t,) causes A(XOR)B to go low, implying that the LSB = 0, LSB + 1 =1, 
and the count is FFFE. The first negative edge on the A channel (at t,) produces 
a 1 on the output of the XOR gate and the count is now FFFD. The first negative 
edge (at f,) on the B channel results in both the LSB and LSB + 1 being 0. 
However, another count-down pulse is generated so that after the first encoder 
line, the count is FFFC. Clearly, the resolution has been increased fourfold. 

As mentioned above, it is possible to increase the resolution of an optical 
incremental encoder by factors considerably greater than 4. To accomplish this, 
however, it 1s necessary to use the “raw” or (almost) sinusoidal waveforms from 
the photodetectors. Additional channels of information are generated from these 
signals by appropriately adding and subtracting them to obtain additional sets ° 


Sec. 5.4 Robot Calibration Using an Optical Incremental Encoder 355 


A Leads B 


1 
A@B 
0 


; 
—_ Down 
10+B 0 | | | | | | | | Count 


Up 


(High) Count 


DO 
20+B oO 


Figure 5.3.18. Timing diagram for the X 4 circuit of Fig. 5.3.17. Clockwise 
motion of the encoder disk causes A to lead B and results in a decreasing count. 


rent phase relationships with respect to the original ones. TTL 
conversion is then performed, and an increased number of counts for each encoder 
line sensed results when schemes similar to that shown in Figure 5.3.17 are utilized. 
In effect, the extra signals are used to produce “more edges” which can be counted 
with the appropriate digital circuitry. To avoid sensing errors that cause counts 
to be “dropped” for this type of higher-resolution scheme, it is necessary to carefully 
maintain the quadrature relationship between the A and B channels. 


signals having diffe 


5.4 ROBOT CALIBRATION USING AN OPTICAL INCREMENTAL 
ENCODER 


In the preceding section we described the optical incremental encoder in consid- 
erable detail since for robots it is generally the position sensor “‘of choice.”” One 
question that may have occurred to the reader is: How can an incremental device 
be used to obtain the absolute position information required by a robot? Indeed, 
it appears on the surface that it cannot and that the need for knowledge about 
where a robot axis actually is within its workspace can be met only by an absolute 
device. However, as we will now see, this is not the case and, in fact there are 
at least two distinct methods in current use which permit the incremental encoder 


to be utilized as an absolute device, with the resultant cost savings. We now 
consider each in turn. 
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5.4.1 Zero Reference Channel 


The difficulty with an incremental encoder is that it provides positional] 
(or the “count’’) only for a single rotation of the encoder disk. Sin 
robotic axes require that the actuator (e.g., the servomotor) must complet 
Over 100 turns in order to cause the joint itself to make one complete mr Well 
some method of keeping track of the rotation number must be included. ‘Mire, 
It is not difficult to do this. As an example, for a 300-line encoder, a Meee 
counter” could be implemented so that every time a full 300 lines was cote 
the rotation count would be incremented or decremented depending on the , 
rotation direction. a 

. The major problem with this scheme, however, is that on a Power-up cop. 
dition, the digital system does not know which “turn” is being sensed. Ajj infor- 
mation is relative to wherever the robot finds itself when it is first energized. Thus 
some method of calibrating or initializing the system is obviously required. A 
commonly used technique for accomplishing this is to add an additional channel 
of information to the encoder disk. Called a zero reference channel, it consists of 
exactly one line and produces a single index pulse for each encoder revolution. 
Clearly, counting these pulses immediately provides information about the revo- 
lution number. This is only one use of this channel, however. 

A second and more important role for the zero reference channel is in the 
calibration of the robot axis. When power is applied to the robot, each Joint is 
caused to move (often at a constant velocity, although this is not critical) in a 
predetermined direction toward a mechanical end stop on the axis. The actuator 
continues to turn until the end stop is encountered. The stoppage can most easily 
be detected by using the encoder and looking for a situation where over a (short) 
period of time, the count does not change. Note that it is not necessary to know 
the value absolutely. All that is required is that the current count be the same as 
that obtained, for example, 100 ms before. Once the system recognizes that the 
axis has reached its mechanical end of travel, the actuator is reversed and continues 
until the first index pulse is generated. At this point, the counter can be initialized 
to zero. All subsequent motions will be relative to this calibration point, and 
absolute position can be obtained simply by reading both the encoder count and 
the number of index pulses accumulated. 

Note that it is not always necessary to utilize an index pulse to obtain oa 
position information. As before, the calibration procedure begins by having ns ; 
axis move until it reaches its mechanical end stop. At this point, the encoder ws 
is noted and the actuator reverses direction. However, in this case, the sare 1 
ceases only after a specified number of encoder counts have been ne 
(relative to the end stop value). Finally, the count is initialized, thereby comP 
the calibration phase. 

Although this calibration procedure is used on some robots today, . 
some problems. For example, the calibration point is sensitive to sommes 3 
and line voltage fluctuations. Yet this potential difficulty must be welg 
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there are 
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the cost reduction obtained by eliminating the zero reference channel. For some 
robots, this can make such a scheme attractive from a cost standpoint. 


5.4.2 Absolute Position Using a Pot and an Incremental 
Encoder 


A second technique exists for utilizing an incremental encoder in an absolute 
position application. In this case, a pot is used together with the encoder. The 
reader may be surprised at this in view of the discussion of Section 5.2.1, where 
it was stated that it is difficult to use pots as position sensors on robots because of 
severe reliability problems caused by electrical noise. However, it is possible to 
get around this problem by using the pot for “coarse” and the encoder for “‘fine”’ 
position information. 

In actual operation, the pot is mounted on the same shaft as the optical 
encoder disk. It may be necessary either to use a multiturn device of an N:1 gear 
reduction so that N actuator turns produce a single rotation of the pot wiper. 
Regardless of which scheme is used, the pot voltage is divided into N discrete 
values, each corresponding to a specific actuator revolution number, stored in a 
table in the system memory. By comparing the actual pot voltage with the tabular 
data, the particular rotation number can be determined. This is the coarse position 
information. The encoder count can then be used in the normal manner to obtain 
the true (i.e., fine) position within any particular rotation. 

This scheme avoids the major difficulty with using a pot—that is, position 
errors due to noise produced by the sliding contact of the wiper. The reason 1s 
that the pot is being used to monitor only a set of discrete positions (i.e., the 
actuator rotation number). No error will be made as long as the pot’s output 
voltage is within a range of + V/2N volts of the ideal value, where V is the applied 
dc voltage to the entire pot resistance. It can be seen from this discussion that a 
certain degree of noise immunity has been imparted to the system by utilizing this 
approach. Of course, when the noise level exceeds +V/2N, the pot must be 
replaced. It is for this reason that a thin-film device is often employed to increase 
the time between such replacements. 

One of the interesting features of this hybrid scheme is that the robot can be 
calibrated in almost any position in the workspace. When power is first applied 
to the controller, the axis actuators are commanded to rotate until the first index 
pulse on each encoder is sensed. The pot voltages are then read and the particular 
actuator rotation number is determined by table lookup. At this point, the position 
counters are appropriately ‘nitialized, thus completing the calibration phase. As 
an example, if a pot voltage corresponds to the tenth actuator revolution, the 
rotation portion of the position count isset to 10. (The encoder count is, of course, 
initialized to zero since the index pulse is being read.) | 

Although the pot can be used to determine the rotation number after cali- 
bration has been completed, this is not usually done. The use of the index pulse 
for this purpose is essentially noise-free, whereas employing the pot increases the 
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probability of an error. Thus the pot is only a factor during calibration wit. . 
major role being to permit the initial absolute position to be obtained, Ith itg 
There are two major disadvantages of this system as compared tg t 
digital/mechanical end stop technique. The first has been mentioned alreag PAE 
is, the necessity of periodic replacement of the pot. | Maintenance jis, theres . 
greater when the hybrid scheme is used. A second disadvantage is that there le, 
positions within the workspace where the robot may not be able to Perform 
calibration without striking one of its links. To prevent this from Occurring the 
robot will not permit a calibration to be performed. In this case it may be Necessa : 
to power down and manually move the offending joint (or joints) to a “better” 
position within the work volume. Note that this step 1s never necessary whey ; 
mechanical end stop is an integral part of the calibration procedure, as in the cas, 
of the pure digital method described in the preceding section. 
A final word is in order concerning the two methods described in this Section, 
The major difference between the two techniques is that when power is first applied 
to the robot controller, the system utilizing the hybrid scheme “knows where it is” 
with an error of at most one actuator rotation. On the other hand, a system that 
employs the pure digital technique (with an end stop) only knows where it is once 
the calibration phase is completed. Before that it is truly “lost in space.” Al- 
though this may appear to be a disadvantage, it really is not since uncalibrated 
robots are not very useful devices. Thus regardless of the scheme employed, 
calibration must first be performed before any useful work can be done. 


55 INSTABILITY RESULTING FROM USING AN INCREMENTAL 
ENCODER 


In the preceding section we saw how an incremental encoder could provide accurate 
and reliable position information. However, a potential difficulty with this — 
is that the mechanism that incorporates such a sensor in its servo may actually 
oscillate. Let us see how this situation can occur and also what steps can be taken 


to prevent it from being a problem. 


5.5.1 Digital Jitter Problem 


As there 


First suppose that a robot axis is required to hold a load horizontally. ne erro! 


“= no motion required, the desired and actual positions are the same and 


oe ° . . jnue in- 
signal in the position servo is zero. However, this situation cannot oor nfluent® 
e . . * ° . . e t e ‘ 
definitely since the robot’s joint will begin to rotate downward due to -« utilize 


of gravity. If for the moment we assume that no multiplying eT 
with the N-line incremental encoder that is on the joint actuator, t the servo 
continue to move until the first encoder line is counted. This means tha 1 the 
will have no knowledge that the desired and actual positions are d 


ifferent eat F 
e. os , . ene 
actuator has rotated 360/N degrees! At this time, an error signal will be & 
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and the actuator will return the joint to the desired horizontal position. The reader 
can readily understand that the entire cycle described above will repeat so that the 
load will not remain in the “home” position but will, instead, oscillate about ie 
This oscillation, which is characteristic of most digital-position servos, is a “limit 
cycle”’ and is often referred to as digital jitter. Clearly, such behavior is quite 
undesirable in a robot, and for that matter, any precision positioning device. What 
can be done about it? 

One possible way to reduce the digital jitter problem is to employ multiplying 
circuitry with the incremental encoder. Based on what was said in the preceding 
section, a X M circuit will increase the resolution of the device M-fold so that the 
joint actuator will now rotate only 360/(N x M) degrees before the error signal is 
generated. Also, an encoder with more lines can be utilized with the same result 
expected. It is clear that both of these techniques reduce but do not entirely 
eliminate the digital jitter problem. 

Note that where a fair amount of friction is present, as in the case of some 
robot joint mechanisms, this may be all that is needed to prevent the limit cycle 
from occurring. Where the friction does not damp out the oscillation, however, 
other measures are required. 


5.5.2 Analog Locking of a Position Servo 


The digital jitter just described comes about due to the discrete or quantized nature 
of the error signal. Obviously, if this error was continuous, there would be no 
such problem. In this regard, one of the advantages of an analog position sensor, 
such as a pot, is that it does produce a continuous signal, and thus its use would 
prevent digital jitter from occurring. However, the reader will recall that the pot 
suffers from other problems that make it unsuitable for most precision positioning 
applications, including robotics. Fortunately, the encoder can again be used to 
“save the day.” 

As mentioned earlier, the output of the photodetectors used in an optical 
encoder is very nearly sinusoidal. It is this fact that can be put to good advantage 
to practically eliminate the digital jitter problem. Under normal operating con- 
ditions (i.e., during motion), the “‘raw”’ or sinusoidal information is still converted 
into TTL pulses, so that the digital nature of the encoder remains unchanged. 
However, when the final desired position has been reached, the raw encoder signal 
is utilized to provide the required analog information. The digital command (i.e., 
desired final or home position) input to the servo is switched out and is replaced 
by an analog voltage of zero, resulting in a scheme that is sometimes referred to 
as an analog lock. 

To see how analog lock operates, consider the previously described situation 
of the loaded robotic joint being held horizontally. As soon as the axis begins to 
rotate away from the desired home position, an error signal is immediately sensed 
and a restoring torque generated, thereby causing the joint to return to “home.” 
With reference to Figure 5.5.1, if gravity causes the joint to move to point A (or 
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Single Encoder 
Channel Output 
(Raw Signal) 


Position 





Figure 5.5.1. “‘Raw” signal for one channel of an encoder. When used in a 
position servo, points D and F are ‘“‘unstable’’ whereas points C, E, and G are 
Stable as indicated by the arrows. 


B), a nonzero error signal is produced that is sufficiently large to drive the joint 
in a direction so as to minimize this error. It is clear that a very stiff servo can 
be produced if the voltage from the photodetector is followed by an amplifier with 
a large gain. In this case, a smaller angular rotation of the joint will produce the 
required error drive so that point A (or B) will now be A’ (or B’). Thus the 
system will sense the error “more quickly,” that is, closer to point C corresponding 
to encoder line K, the one nearest the desired final point. By increasing the gain 
of the amplifier, we can make A’ almost coincident with C. 

It is important to note that points D and F can never be ‘“‘held”’ (i.e., they 
are unstable positions; see Problem 5.26). Also, the analog locking scheme can 
produce an error of one full encoder line if steps are not taken to prevent this from 
occurring (see Problem 5.27). 

Currently, most robotic servos do not require an analog lock because the 
joint mechanism friction is sufficient to damp out, or inhibit, the limit cycle. How 
ever, as higher-performance robots become more commonplace, it is expected that 
friction will be reduced and some method of preventing digital jitter from occurtne 
will be necessary. This is already the case in other high-precision positionIne 
devices (e.g., high-speed wire bonders). 


5.6 VELOCITY SENSORS 


yelocily 
int, the 
obtains 


As noted in Chapter 4, a robotic servo must make use of both position and 

signals to produce the desired manipulator performance. Up to this p° 

monitoring of position has been discussed. The question of how one 

velocity information 1s the topic of this section. rating 
As we will learn, it is possible to determine the angular velocity of a ro 


use 
shaft in several different ways. For example, the dc tachometer has been 
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extensively for this purpose in many different control applications, including ro- 
botics. In addition to this analog device, however, it is possible to utilize an optical 
encoder and a frequency-to-voltage converter to obtain analog velocity. Alterna- 
tively, the optical encoder itself can be made to yield digital velocity information 
when combined with the appropriate software. We now discuss, in turn, these 
various techniques for measuring velocity. 


5.6.1 DC Tachometers 


It is well known that rotating the shaft of a de motor will produce an analog voltage 
that increases (or decreases) with increasing (or decreasing) shaft angular velocity. 
In effect, the motor becomes a dc generator and can therefore be utilized to measure 
the shaft speed. Although it is possible to use almost any de motor in this appli- 
cation,* dc tachometers are usually specially designed devices. ‘There are a number 
of reasons why this is so. 

The first and perhaps the most important one is that the tachometer (‘‘tach’’) 
should produce a dc voltage that not only is proportional to the shaft speed but also 
has a voltage versus speed characteristic that is ideally linear over the entire op- 
erating range. (Some deviation from linearity is usually acceptable at speeds below 
100 rpm, however; see Figure 5.6.1.) ‘This permits the tach to be most easily used 
as a velocity sensor in control applications. Normally, the generated voltage pro- 
duced by a dc motor will not possess the degree of linearity required in these cases. 

A second reason for not using a motor in such an application is that the tach’s 
output voltage should be relatively free of voltage ripple in the operating (i.e., 
speed) range of the device. Although a certain amount of ripple is permissible 
and can usually be handled with a low-pass filter, too much may produce unwanted 
jitter in the device being controlled. This would be particularly offensive in the 
case of a robotic manipulator. In general, a dc motor will produce too large a 
ripple for most control applications, so a specially designed device is preferable. 

The final reason for not using a dc motor as a tach is that volume and/or 
weight is often an important system design consideration. As we mentioned be- 
fore, this is certainly the case for the axes of an industrial robot, where the actuator 
must often be carried along in the joint itself. Since the tachometer supplies little 
if any current to the rest of the servo system, the output power requirement of the 
device is minimal. Thus it hardly makes sense to use a motor in this application, 
and a smaller device is quite satisfactory. 

It is found that a permanent-magnet iron—copper armature tachometer will 
satisfy the above-mentioned characteristics. The speed—voltage curve of this an- 
alog device is quite similar to that shown in Figure 5.6.1. The underlying principle 


*Geiger, Dana, “Regulating Servo Speed without a Tachometer,” Control Engineering, October, 
1979, pp. 73-74. 
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Figure 5.6.1. Output voltage versus speed transfer characteristic of an analog 
tachometer. At low speeds, the actual device (nonideal characteristic) is not linear. 


of the tachometer can be understood by recalling that a wire moving in a magnetic 
field will induce a voltage across the wire that is proportional to its velocity and 
the sine of the angle between the magnetic field direction and the coil’s plane. 
This angle is 90° when the wire’s plane and the field are perpendicular to each 
other and results in the maximum voltage being developed. 

In practice, the armature’s copper (or aluminum) coils are wound longitu- 
dinally on a cylindrical piece of iron as shown in Figure 5.6.2. It can be seen that 
the ends of the coil are connected to a commutator, which is a segmented ring. 
Here only one coil is detailed, but normally there will be many (e.g., 11) spaced 
equally around the circular cross section. The corresponding commutator will then 
have twice as many segments as coils. The sliding electrical contact 1s usually 
obtained by a set of two or four carbon brushes which touch the various segments 
of the commutator. 

Based on the above, the operation of the “rotary iron” dc tach can be under- 
stood. As any single coil rotates in the field of the permanent magnet, the induce 
voltage varies sinusoidally with angle. Thus at constant velocity, the voltage bil 
also be sinusoidal in time. The brush/commutator assembly will act as a rectifying 
element by reversing the coil connection for each half of a complete revolution. 
In this manner, a pulsating dc voltage is produced. All other armature coils Ww! 
also produce a sinusoidal voltage of differing phase with respect to the first one 
Since the coils are evenly distributed around the armature’s cross section, the ” ; 
voltage output by the brushes is very nearly constant (i.e., dc). The small s 
component of the voltage that is present is referred to as ripple. Tachomer* 
currently being manufactured usually produce ripples of about 5 to 5% of the 


output. 
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showl : 
- ai galll coil (of many) mounted on 
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A more costl 
; y alternative t 
a moving coil for the o the rotary iron des! ; 
ar a sign d 
is achieved by a amen In this instance, a si oii acer above is to use 
iron is removed. ‘This is Renita “cup” whereby most, if not be geese wabetnneitt 
of the copper (or ey ors by fabricating a rigid c = the armature’s 
In addition, it is possibl ) coils or skeins using polym aan eat 
ainiataets a tg phos utilize more coils (G: g 19 - af resins and fiberglass. 
permitting the ripple Sie aa of this type of ne este . By eliminating the 
Typical values are in th age to be quite a bit smaller than f Sirapleincarecandlg tain 
coil design allows hore ores of 1% of the dc output Also, b rotary iron device. 
bat eee aa coils to be utilized, the | , because the movin 
improved over that , the low-speed perf e 
It should be 1 that obtained by the 3 ormance of th 
clear that if rotary iron vers! © 
‘he moun if an analog tachom : ; ersion. 
g-coil vers eter is used 
because of the veductiil . aca probably the more tinue aidan application, 
hence weight is not a she No “7 axes where the cnaaeae two designs 
to the redu ation, the rotary 1 , not carried 
ced cost. y iron design and 
handled with a low- ie. the fact that in this case m8 re be preferable due 
dived aanauin pass 1 ter, its low-speed performance m reased ripple can be 
As ot this a 09 —. may still be the unit of pared still be objectionable 
of an analo iting, the most common cla is 
g tacho ss of industria 
is that the cst — SCARA (see Section 4 — that makes use 
against gravity. Rec " of such a robot does not require the ~ prunary reason 
the sravitational oad that the major axes of aSCARA Ss een to be lifted 
difieant wdaiGodsl b Pag heey added weight of the tach ie perpendicular to 
chanical structure bench ane i load) to either the saciaiaats ect a sig- 
against gravity, it i nipulator. Howeve otor or th 
it r, where th © me- 
the velocity len: i usually preferable to employ different motor must be moved 
gnals. We now discuss two such methods eonnique for obtaining 
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5.6.2 Velocity Measurement Using an Optical Encoder 
weight penalty that must be incurred when ugi, 


s often unacceptable in robotic applications where 


ed above, the added 
lar manipulator link against gravity 


genet tachometer i 


the actuator must be moved with the particuls PT eleia i ! 
In this instance, an alternative to the extra piece O required. Foy. 


tunately, the optical encoder described in an earlier section of this chapter, ang 
ailable for monitoring shaft velocity 


already used for position determination, is avalle’ 7 
Two techniques exist for doing this. The first utilizes both the encoder anq 
a frequency to voltage converter (FVC) to provide an analog voltage that is pro. 
portional to shaft speed. As far as the user 1S concerned, it behaves very much 
like the dc tachometer described in the preceding section. The second technique 

to provide a digital represen- 


makes use of the encoder and appropriate software to Pp , 
tation of the shaft velocity, pure digital servos, as described in Chapter 4, would 


utilize this approach. In fact, most robots today do indeed use the optical encoder 
to produce digital position and velocity information. We briefly describe these 


two methods. 


As mention 
a permanent-ma 


5.6.2.1 Encoder and frequency-to-voltage converter 

is chapter showed how the TIL pulses produced 
der could be used to monitor position. The ques- 
Is be processed so that velocity information 
definition of velocity; that 1s, 


An earlier section of th 
by an optical incremental enco 
tion arises: How can these signa 
is also obtained? The answer is found in the basic 
the time rate of change of position. Thus if the number of encoder pulses is ob- 
served (and counted) periodically and this number is converted to a dc level, the 
produced will in fact be proportional to the shaft velocity. Clearly, 
proximating the derivative by Ax/At. Here, At is the “sampling” 


signal so 
d Ax is the number of TTL pulses produced during this time 


we are ap 
interval (or period) an 
ncy-to-voltagé 
logy accepts 
y generale 


hen output 
al to 


interval. 
ccomplishes the above is referred to as a freque 


A device that a 
converter or FVC. This product of advanced integrated-circuit techno 
both channels of the TIL encoder pulses and, using its own internall 


clock, counts these pulses during each clock cycle. The binary count is t 
to an internal DAC which produces the desired dc voltage that 1s proportion 
the encoder disk speed and hence the motor shaft speed. An example of an 
‘s the Analog Devices AD 451 shown in Figure 5.6.3 in block diagram form. This 
unit will produce a 0- to 5-V output for pulse repetition rates of de to 10 kHz. 
(The AD 453 will go to 100 kHz.) 
How does the velocity signal produced by this device compare to that of a” 
f the 


First, the output of the FVC has Jess ripple than that 0 
he internal V/> 


analog tachometer? 
tach, and in fact the nature of this ripple is totally different. T 


produces a piecewise constant output which, depending on its conversion 
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Figure 5.6.3. Block diagram of an Analog Devices 451/453 frequency-to-voltage 
converter. The 451 has a frequency range of dc to 10 kHz, whereas the model 
453 can handle pulse repetition rates up to 100 kHz. (Courtesy of Analog Devices, 
Norwood, MA.) 


have a period (i.e., an update rate) which is so small that it will cause the FVC’s 
output to appear to be continuous in most applications. Thus, unlike the analog 
tach, no low-pass filter is needed when using the FVC. Second, the FVC will 
exhibit more time delay than the tach, the exact amount depending on the internal 
clock rate. In high-performance systems, such as semiconductor wire bonders that 
require servos having large bandwidths, this delay can create stability problems 
which must then be dealt with using additional compensation. However, in the 
case of the servos used to control robot joints, the extra phase lag created by the 
delay is usually not of any consequence due to the much smaller bandwidth re- 
quirements. 

Why is it that we do not find the FVC being used extensively in robotic 
systems? One reason is that current prices for the devices are on the order of $50, 
making the FVC almost as costly as an analog tachometer. As we will see, there 
is a considerably less expensive way to use the encoder signals to obtain velocity 
information. Another reason for not using the FVC is that hybrid servos, involving 
digital position and analog velocity, are not as frequently utilized. More common 
in robot systems are pure digital servos. 


5.6.2.2 Encoder and software 


As indicated above, there is a way to obtain velocity information using an 
incremental encoder by processing the position data. One simple technique is to 
Once again approximate the velocity by Ax/At. Rather than having a special- 
Purpose chip perform the operation as 10 the case of the FVC, the following short 
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computer algorithm can be utilized assuming that the position is updated (i.e. th 
encoder count is read) every T seconds: > ie 


1. Read and store the current encoder P(kT). 

2. Retrieve the previous encoder count P((K — 1)T) (this was the position r 
seconds earlier). 

3. The approximate velocity V(kT) is given by 


P (kT) — P((k — 1)T) 


V(kT) = = 


4. Increment k and repeat steps 1 through 3. 


This algorithm is quite easy to code and requires little time to execute. How. 
ever, it is based on a first-order approximation of the derivative which may be 
inadequate in some applications. In this instance, a second- or higher-order ap- 
proximation must be used. Note that if this is done, the execution time will be 
increased and additional phase lag will be introduced into the digital servo loop, 
thereby necessitating extra compensation in order to stabilize the system. 

Also, it is important to select carefully the update time T in the algorithm. 
Too large a value may cause the “‘sampling theorem”’ to be violated so that there 
will be a large error between the actual velocity and V(kT). Too small a value 
will mean that low-speed performance of the algorithm will be poor since the 
position count will change very little, if at all, from update to update. This problem 
was discussed in Chapter 4 (see Section 4.5.2). 


5.7 ACCELEROMETERS 


Besides monitoring the position and velocity of a physical system, it is also possible 
to monitor its acceleration. Normally, linear acceleration is measured, whereas 
angular acceleration is most often derived from angular velocity by differentiation. 
Let us consider briefly how a device that can be used to obtain linear acceleration, 
and referred to as an accelerometer, operates. 

From Figure 5.7.1, it can be seen that an accelerometer consists of three bas!¢ 
elements: 


1. A mass M 


2. Some type of linear displacement sensor (e. g., an LVDT) 
3. A set of springs having an equivalent spring constant K 


Based on one of Newton’s laws (i.e., F = Ma, where F is the force needed 
to accelerate the mass (M) a linear units per second per second), it is ¢asy 
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y (Direction 
of Motion) 


Rigid 
Mounting 
Structure Figure 5.7.1. Basic elements of a lin- 
ear accelerometer. The LVDT is used 
to monitor the relative displacement of 
the lower spring, a quantity that is pro- 
portional to the acceleration. 





understand the operation of this device. Suppose that the entire accelerometer 
begins to move (i.e., 1s accelerating) in a downward direction. The force required 
to do this (e.g., Ma) will be opposed by the springs supporting M. As they bend 
upward a distance y, this force will be equal to Ky. Thus 


Ma = Ky (5.7.1) 


Solving for the linear acceleration a gives 
(3.72) 


From this equation it is apparent that the acceleration of the mass is proportional 
to the distance. If an LVDT is used to determine linear position, as is often the 
case in commercial accelerometers, the output of that sensor will be proportional 
to the actual acceleration. ‘Thus the signal-processing device used in an LVDT 
and described previously can be made to read acceleration directly. 

Not mentioned in the discussion above is the fact that to be a useful sensor, 
the accelerometer must also include enough damping so that the spring—mass 
combination does not “ring” significantly (i.e., produce damped sinsoidal oscil- 
lations). Normally, it is desirable to have a small amount of overshoot of the final 
displacement position so that a damping constant of 0.6 or 0.7 is used. Under 
these conditions, an accelerometer can monitor motions having frequency com- 
ponents that are at least 2.5 times lower than the undamped (or “natural’’) fre- 
quency of the second-order mechanical system composed of the mass, spring, and 
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damping. That is, the operating frequency f should obey the inequality 
Although commercial accelerometers can be obtained that will Measure ac. 


celerations ranging from +5 to thousands of g’s,* these devices have had limiteg 
use in robots currently being manufactured. One reason is that, as Mentioned 
above, it is usually possible to determine only /inear acceleration directly, Since 
most robot joints are revolute rather than prismatic in nature, it has been deemeg 
more useful to measure position and/or velocity of the joint directly. If Necessaq 
the acceleration signal can be derived from these data. Another reason for not 
using acceleration is that even if it were easy to measure this rotational quanti 
directly, it would still be necessary to process the information so as to get the 
desired position and velocity data to control the robot joint. The reader will recajj 
(Chapter 4) that with robots, we are dealing with a position servo so that it seems 
to make more sense to monitor the position directly rather than indirectly (i.e. 
by performing two integrations on the acceleration signal). Certainly, one would 
expect fewer errors and/or uncertainties using the direct approach. 

There have been a few experiments with accelerometers and robots, however. 
In most cases, the sensor has been used together with standard encoders to provide 
an estimate of the actual motion of the joint being controlled. It will be recalled 
that most position sensors are mounted on the actuator Output before the rotary 
motion is geared down, in order to achieve the desired position resolution. The 
assumption is made that if the actuator’s motion is controlled, the joint will respond 
in an identical manner. Clearly, this is not always true because mechanical linkages 
and/or couplings are not perfectly rigid. Generally, mechanical resonances that 
occur as a result cannot be compensated for by sensors so placed. However, an 
accelerometer mounted on the joint structure can provide information about what 
the joint is actually doing. These data, together with those from the actuator 
position sensor, can be possessed to compensate partially for the nonideal motion 
of a robot axis. The accelerometer is thus used to “observe” the actual jot 
behavior. In fact, at least one commercially manufactured robot utilizes a single 
axis accelerometer on its prismatic joint to reduce undesirable arm oscillations 
caused, in part, by imperfect mechanica] linkages. Readers interested in learning 
more about the use of such sensors are encouraged to read the references al the 
end of this chapter, where linear optimal estimation theory is employed in 4 
attempt to improve the performance of a robot [3, 4]. 

Recently the Pennwalt Corporation o 
begun to market a piezoelectric 
device has been shown to be far 


f King of Prussia, Pennsylvania, “ 
polymer (i.e. PVDF)-based accelerometer. _ al 
more rugged and sensitive than the more tradition 


"A g represents the acceleration due to gravity; that is, 32.2 ft/s? 
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e industry 
devices. Moreover, its cost is about an order of magnitude less than th 
sandaxd unit with virtually the identical frequency response. 


-.g PROXIMITY SENSORS 


. « . 
Up to this point, we have discussed the behavior and nck nomen - pray orto 
were used to measure the position, velocity, or acceleration of r ieacneiae 
more accurately, their actuators) and were called collectively interna i ie netric 

d major class of robotic sensor is used to monitor the robot’s ge 

Sat ¢ ' metimes referred to as 
and/or dynamic relation to its task. Such sensors are SO ‘onan 
external state sensors. Machine or robotic vision systems represent an | a 
subclass of this group of devices and are treated separately in a : Rial 
remainder of the current chapter is devoted to non-vision-type sensors that ¢1 7 
can be or have already been used to make the robot more aware of its extern : 
environment. Although some of these may utilize optical techniques as part O 
their sensing system, they are not properly classified as visual sensors, SO we describe 
them in this chapter. Also, as will be seen, many are still under development in 
various research facilities and are therefore not ready for use In an actual manu- 
facturing environment. Since it is not possible to treat this subject in an exhaustive 
manner, readers desiring more information are referred to the references at the 
end of the chapter. Of particular note is an excellent summary report by D. J. 
Hall [5] of Carnegie—Mellon University’s Robotic Institute which was quite helpful 
in preparing much of the remainder of this chapter. 

In this section we describe a number of sensors used to tell the robot when 
it is near an object or obstruction. This can be done either by using a contacting 
or a noncontacting technique. Often, such sensors are called proximity devices, 
but the distinction between proximity and touch and/or slip is not clear-cut. That 
is, Some proximity devices can also be used as touch (or factile) sensors. We will 
consider only the proximity feature here, deferring the discussion of their appli- 
cation to touch and/or slip detection to a subsequent section. 


5.8.1 Contact Proximity Sensors 


The simplest type of proximity sensor is of the contacting variety. As Figure 5.8.1 
shows, such a device consists of a rod that protrudes from one end and a switch 
Or other linear position-monitoring element located within the body of the sensor. 
As the robotic manipulator moves, the sensor will become active only when the 
tod comes in contact with an object or an obstruction. When this occurs, the 
Switch mounted inside the sensor will close (or open, if that is more convenient). 
The change of state of the switch, monitored through the robot’s /O interface 
will cause an appropriate action to take place. Examples include an immediate 
(or emergency) halt if the device is used to sense obstacles or the branching to 
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Figure 5.8.1. Simple contact rod proximity sensor mounted on 
one “‘finger” of a robotic gripper. 


another part of the robot’s program, thereby causing a particular operation to be 
performed (e.g., closing of the gripper). Such contact monitors can be Placed 
anywhere on the robot’s arm and/or wrist, and it is possible to utilize more than 
one. ‘Thus simultaneous obstacle and object sensing is possible. 

If the simple on-off switch is replaced by one of the linear position-sensing 
devices described in an earlier portion of this chapter, the “binary” contact prox- 
imity seusor becomes one that can detect actual position of the object (or obstacle). 
For example, a simple pot or an LVDT can be employed. Then once the protruding 
rod makes contact, further motion of the manipulator will push the rod into the 
sensor. If this rod is attached to the magnetic core of an LVDT or the wiper of 
a potentiometer, the motion will be converted into a voltage that will be propor- 
tional to the actual distance of the end of the rod (and hence the object) from 
some reference point on the robot (e.g., the end of the gripper). In addition, the 
approach velocity can be obtained from this information by performing either an 
analog or digital differentiation. Thus both distance and approach velocity can be 
monitored using such a contact sensor. 

It is important to understand that a single contact proximity device cannot 
provide any information about the shape or nature of the object or obstacle (i.¢., 
no object recognition capability is possible.* It will be seen in a later section, 


however, that some degree of object recognition can be obtained by utilizing arrays 
of these devices. 


5.8.2 Noncontact Proximity Sensors 
In contrast to the devices described above, a m 


does not require any physical contact at all in 
be used by a robot to determine whether it js 


uch larger class of proximity sensor 
order to produce a signal that can 
near an object or obstacle. Thes¢ 


*Some information about object shape can b 
once the first contact has been detected. This wil 
perform, however (see Problem 5.42). 


¢ obtained by having the robot execute a search, 
|, most probably, require a good deal of time '© 


Sec. 5.8 Proximity Sensors 371 


noncontact devices depend on a variety of operating principles in order to make 
the proximity determination. For example, reflected light, ultrasound, or variation 
in capacitance, inductance, or resistance have all been used. We now briefly 
describe a number of such sensors. 


5.8.2.1 Reflected light sensors 


One of the simplest types of proximity sensors that uses light reflected from 
an object and has been used experimentally on a robot gripper is shown in Figure 
5.8.2a. The sensor consists of a source of light and a photodetector separated by 
about 8 mm and tilted symmetrically toward one another. This, together with 
lenses mounted in front of the assembly, produces focused incident and reflected 
beams. Figure 5.8.2b shows the photodetector voltage as a function of object 
distance from the (detector) lens. Figure 5.8.2c indicates that several of these 
sensors can be placed on a robotic gripper. In this way, proximity in several 
directions can be monitored simultaneously (e.g., ahead and below the robot's 
hand). 

Although the maximum sensor output will occur when an object (or obstacle) 
is at the focal point, Figure 5.8.2b reveals a basic difficulty with this device. ‘That 
is, two different object positions produce the same voltage except when the object 
is located exactly at the focal point. Since a one-to-one.correspondence between 
position and detector voltage does not exist, additional logic or hardware is required 
to eliminate the ambiguity. For example, if the robot is moving and the sensor 
signal is increasing, it is clear that the object is on the far side of the focal point 
(i.e., has yet to reach this point, and so the output corresponds to the Jarger of 
the two position values). If, however, the signal is decreasing, the focal point has 
been passed and the smaller distance should be used. Several sensors placed at 
angles can also be utilized to eliminate this ambiguity. In addition, Jet Propulsion 
Labs (JPL) has embedded fiber optic filaments inside the fingers of the robot so 
that the effective voltage characteristic of the sensor is monitonically decreasing 
with distance (see Problem 5.32). 

Besides this difficulty, other problems with the sensor exist. For example, 
ambient light will shift the curve in Figure 5.8.2b up or down depending on the 
intensity. The problem has been solved at JPL by pulsing the light source at a 6- 
kHz rate. However, amore difficult and perhaps impossible problem to overcome 
is that the sensor is sensitive to the reflectivity of the object or obstacle. A highly 
reflective surface will obviously produce a larger output voltage than one that is 
less reflective. Thus it might be necessary to ‘‘calibrate”’ the sensor to each object 
so that the maximum output voltage could be found. Then, knowing the char- 
acteristic of the detector, position could be determined relative to this maximum 
value. Alternatively, careful control and/or an a priori knowledge of the surface 
reflectivity would be required. ; 

Even with these measures implemented, it would still be difficult to use the 
sensor for absolute position monitoring. The major reasons are that the device 
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would be quite sensitive to variations in light-source Output, drift in the detector 
characteristics (due to ambient-temperature fluctuation), and environmentally caused 
changes in the reflectivity of the object. Thus all that could be reasonably expected 
would be to sense the proximity of an object to the robot’s gripper within a ban 
of distance. A threshold detecting circuit might be utilized to achieve this. 

It is rather disheartening to realize that what at the outset appeared to be 4 
simple and ideal noncontact proximity sensor has such great problems associate 
with it that its application to robots is not likely. It is for this reason that othe! 
devices are normally used to monitor proximity in a manufacturing environment. 
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5.8.2.2 Fiber optic scanning sensors 


Fiber optics have been used to develop several different types of noncontact 
proximity sensors. As reported by Fayfield [7], there are at least three systems 
for utilizing this important technology in the robotics and/or the manufacturing 
fields. With regard to Figure 5.8.3, one employs transmitted light, whereas the 
other two make use of reflected light. It is important to understand that it is not 
possible, in all cases, to obtain reliable absolute position information. The devices 
can only tell whether or not a part is present. 


In the opposed or beam break configuration (Figure 5.8.3a), the object is 
detected when it actually interrupts the beam of light. Such an optical interrupter 
depends on the object being opaque and is, obviously, not useful where parts are 
made of transparent or translucent materials. By employing high-gain amplifiers 
and noise-reduction schemes, these sensors can detect objects as close as a few 
mils and as far away as several inches. However, they are limited to informing 
the robot that something is or is not present. That is, absolute position information 
cannot be obtained. In addition to this, the receiver fiber bundle alignment is 
fairly critical. Thus, anything that would tend to misalign it from the emitter 
bundle would obviously affect the sensor’s effectiveness. Finally, it would be 
necessary to use units with different gaps and/or lengths, depending on the type 
and size of the object to be sensed. 

A second type of fiber optic proximity sensor is referred to as a retroreflective 
device since it employs a reflective target placed some distance from the body of 
the unit (see Figure 5.8.3b). An opaque object entering the area between the end 
of the fiber bundle and the target is sensed since reflected light reaching the receiver 
is considerably reduced in intensity. This is also true for parts made of translucent 
materials because the incident beam of light and that reflected from the target are 
both attenuated when they pass through such an object. The use of thresholding 
circuits on the receiver side of the sensor is important in both of these cases. The 
retroreflective scheme utilizes a bifurcated fiber bundle so that incident and re- 
flected light is carried by the same set of fibers. Clearly, this eliminates potential 
alignment difficulties associated with the previous technique. However, the need 
for a separate target somewhat restricts the use of such a sensor to parts detection 
only. It is clear that unless an unforeseen (and unpredicted) obstacle happens to 
disrupt the light from the reflecting target, it will not be sensed by a retroreflective 
mode fiber optic sensor. 

The last fiber optic proximity scheme is shown in Figure 5.8.3c. Here a 
bifurcated fiber bundle is again used, but there is no retroreflective target. The 
Sensor actually can measure the amount of light reflected from an object up to a 
few inches away from the fiber bundle. Since most materials reflect some light, 
this “diffuse” device can be used to detect transparent and translucent objects. 
As in the case of the reflected light proximity detector described above, some 
degree of absolute position monitoring is possible under ideal conditions. How- 
ever, all of the difficulties with that type of sensor that were described previously 
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Figure 5.8.3, Three possible configurations of a fiberoptic scanning sensor: (a) opposed or 
beam break, (b) retroreflective; (c) diffuse. (Redrawn with permission of Production En 
gineering, Cleveland OH. From reference [7].) 
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are also present with the fiber optic version. Nevertheless, this mode of fiber optic 
sensing is the most commonly used one since it is self-contained (i.e., no target is 
required), rugged, weighs very little, and is relatively inexpensive, making it ideally 
suited for a manufacturing environment. 


5.8.2.3 Scanning laser sensors 


A considerably more involved and costly proximity sensor Is shown in Figure 
5.8.4. Consisting of a laser light source, two mirrors, one of which is rotated by 
an ac motor, and a lens-photo-receiver assembly, this scanning laser device has 
been used to permit an industrial robot to arc-weld curved objects [8]. The incident 
light beam from the laser (helium-neon) is ‘‘swept” across the object surface by 
the action of the motor-driven triangular mirror. Note that this occurs three times 
for each motor revolution. A lens mounted in front of a photodetector (€.g., a 
phototransistor) permits light reflected from only one point on the object’s surface 
to be acquired. Distance from the sensor to this point is determined by synchro- 
nizing the ac motor voltage with a high-frequency clock. The number of clock 
pulses from the time this voltage is zero until the photodetector receives reflected 
light is a measure of the distance. Tracking (in the case of the welding application, 
for example) is achieved by mounting the sensor on the end effector of the robot, 
thereby allowing the entire sensor to be moved to different locations in space. 
Black, transparent, or extremely shiny objects cause problems for this proximity 


technique. 


5.8.2.4 Ultrasonic sensors 


Ultrasonics has been used to provide ranging and imaging information for 
many years. For example, naval vessels have used sonar sensing systems to detect 
submerged submarines since the early 1940s. Also, since the late 1970s ultrasonic 
imaging has been used to provide “pictures” of various human organs without 
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subjecting patients to more objectionable forms of pasa (e.g. X-Tays - The 
advent of Polaroid Corporation’s Sonar Sensing element brought ultrasonic rangin 
to the nonprofessional photographic market. As employed on their instant Cam \ 
the Polaroid sensor projects a low (energy)-level electrestalically enerate Ultra. 
sonic pulse and measures the time for the reflected beam or “echo wave” to Tetum 
to the sensor. This information is used to measure the distance to the Object and 
then to automatically adjust the camera’s focus accordingly. In recent ye 
and other similar detectors have been adapted to robots. | 
Although there are several different sonar sensing techniques, robots normally 
utilize devices that produce short bursts of a sinusoidal waveform Whose frequene 
ls above the audio range (e.g., 40 kHz) [9]. From the block diagram in Figure 
5.8.5, the operation of such a sensor can be understood. When an iNitiate Signal 
is given, the transmit (sinusoidal) oscillator is enabled for 1 ms. This causeg 40 
cycles of energy at 40 kHz to be transmitted. In addition, a timing or Samplin 
window enables the AND gate for a specific period of time, thereby Permitting 
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Figure 5.8.5. Block diagram of a pulse sonar, nonco 
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ntact, proximity sensor. Note that : 
(Redrawn with permission of M.H.E. 
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any reflected pulses (fr om the echo wave) to be counted. This count is proportional 
to the distance of the object from the transducer. Thus the maximum range of 
the sensor can be varied by adjusting the sampling window. Errors due to spurious 
signals are prevented by using a narrowband filter tuned to the frequency of the 
transmitted beam (e-g., 40 kHz). The direct wave from the transmitter is not 
counted due to the action of the blanking pulse, which keeps the counter disabled 
until after the transmit oscillator is off (i.e., disabled). 

In the case of the Polaroid device, the burst actually consists of four distinct 
high frequencies: 50, 53, 57, and 60 kHz. This prevents the surface topology or 
material of the object being scanned from “looking” like a matched termination to 
the incident ultrasonic energy which would eliminate or “‘cancel”’ the echo wave, 
thereby rendering the object effectively “invisible” to the sensor. 

The idea behind using a group of frequencies is that the matching effect is 
frequency sensitive. Thus some energy will always be reflected. The “‘penalty”’ 
one pays for this is that the sensing electronics used in conjunction with such a 
device will be more complex since they must be able to handle four different 
frequencies rather than a single one as described above. The accuracy of the 
Polaroid sensor is reported to be about 1% (of its range). 

Arrays of Polaroid sonar sensors have been used by the National Bureau of 
Standards to create a safety “curtain” of sonar energy about an industrial robot 
[10]. If this curtain is broken by someone attempting to enter the workspace, the 
robot is immediately halted and must be reset before it can resume operation. This 
scheme prevents an accident even when an intruder is entirely within the work 
envelope. Note that permitting the robot to continue moving once the sonar shield 
is reestablished would not safely handle such a situation. 

Polaroid and other ultrasonic sensors have also been used on a number of 
mobile robots to determine the distance from walls and obstacles. In one exper- 
imental device developed at Drexel University in 1983, the common problem of 
loss of position calibration due to wheel slippage was practically eliminated using 
a single sonar sensor rotated 180° by a stepper motor to determine the actual 
distance from walls and known obstacles [11]. The robot’s path was taught and 
followed utilizing distance information from incremental encoders mounted on the 
drive-wheel servomotors. Recalibration of the system from time to time was 
achieved ‘‘on the fly” by comparing the actual distance from a particular “land- 
mark” (e.g., a wall) reported by the sonar sensor with that given by the encoder. 
Position counters were then adjusted accordingly. A position error of about 0.5% 
was obtained using this procedure. In another mobile device, 14 narrow-angle 
ultrasonic sensors were placed at various locations on the French HILARE robot 
[12]. The transmission angle of these detectors was 30°, whereas the receiving 
angle was only 15°. The large number of sensors was required to eliminate “‘blind 
Spots” around the perimeter of the robot that would otherwise be present due to 
the Narrow-angle detectors used. Measured distances of approximately 2 m with 


an accuracy of about 0.5 cm were reported. 
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9.8.2.5 Eddy-current sensors 


Another type of sensor used as a proximity switch and for determinin 
accuracy and repeatability of commercial robotic manipulators Operates on + 
eddy-current principle. A typical device of this class utilizes a Sensing coil to induc 
high-frequency (eddy) currents in a ferrous or nonferrous (e.g., aluminum) con 
ductive target. The amplitude of the sensor’s generated oscillation depends on 
the distance between the metal surface and the coil, and this in turn determine, 
the amount of Magnetic coupling in the overall circuit. Consequently, Position 
can be obtained by monitoring the amplitude. 

One technique for doing this employs a “‘killed oscillator,” [13] as Shown in 
Figure 5.8.6. The presence of a metal target near the coil in the sensor’s Probe 
causes the oscillator’s amplitude to drop since the induced eddy currents represent 
a loss mechanism and thus produce damping or “‘killing” of the sinusoidal Wave- 
form. A demodulator, essentially an integrator, responds to such a change by 
producing a smaller dc output. In a proximity switch application, a thresholding 
circuit is used to detect when the level drops below some predetermined value, at 
which point the switch’s state is changed. By adjusting the threshold value, a 
robot manipulator can be stopped at a desired distance from a part or object. This 
scheme can also be used to prevent an inadvertent collision between the end effector 
and another piece of machinery within the robot’s workcell. 

Alternatively, the thresholding circuit and switch can be eliminated and the 
actual dc level from the demodulator used to provide information about the absolute 
distance of the sensor from the object. This type of device has been employed 
by some manufacturers to determine both the repeatability and accuracy of their 
robots. In addition, it is clear that an eddy-current sensor mounted on a manip- 
ulator’s end effector could be used to inform the robot of its distance from a metallic 
part. Another potential application would involve the use of such a sensor and a 
robot to perform various types of inspections on manufactured parts (e.g., shaft 
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Figure 5.8.6. Killed oscillator, eddy current, noncontact, proximity sensor. By haainahler 
the level detector and switch, the device can monitor absolute distance. (Redrawn wil 
permission of Machine Design. From reference [13].) 
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Figure 5.8.7. Operational specifications and dimensions for a family of commer- 
cial eddy-current sensors. (Courtesy of R. Dambman and Kaman Instrumentation 
Corp., Colorado Springs, CO.) 


and commutator runout, plate and disk flatness, or the thickness of nonconductive 
materials). Gaging of certain metal components would also be possible with this 
Class of sensor. 

Eddy-current sensors are ideally suited for the manufacturing environment 
because they are able to operate reliably in areas contaminated by oil and dirt and 
also where there is significant variation in temperature and humidity. They also 
Provide good linearity, with one manufacturer (e.g., Kaman Instrumentation Corp.) 
reporting a specification of 0.5% of the overall measuring range (see Figure 5.8.7). 
This same manufacturer also specs analog resolutions of from 0.004 to 0.12 mils, 
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depending on the sensor’s range. ‘These sensors can be used to measur ete: 
dynamic displacements and hence are well suited for determining one an 
position overshoot under a variety of load conditions. In addition, they « Pulato 
frequency variations of up to about 50 kHz, so that it is possible to use Ps Ee 
measure discontinuities on moving metallic objects. Nem tg 

The major disadvantage of these devices is that they must be Calibrat 
the type of metal used for the target (e.g., aluminum and steel will produce gj ~ for 
sensor outputs). Thus in a robot application, the detector might have to "ig 
calibrated for each different type of part inspected. Also, the effective thi 
measuring range is determined by the size of the sensor, with larger distances 
implying physically larger probes. For example, as shown in Figure 5.8.7, a is 
in.-diameter unit is required to sense distances of up to 600 mils, whereas a 10-mi 
distance needs one that is only 80 mils in diameter. 


5.8.2.6 Resistive sensing 


A problem encountered in the robotic application of arc welding is keeping 
the welding tool (also referred to as a “‘torch” or “ gun’’) tip at a specified constant 
distance from the seam that is to be welded. By doing this and also keeping 
constant the speed with which the gun is moved, the uniformity and strength of 
the weld can be controlled. In addition, a strong weld can be ensured by having 
the robot accurately “track” this seam. A technique that has been developed to 
meet these requirements is called through-the-arc resistive sensing. The funda- 
mental principle underlying such a sensory technique is that for a constant voltage 
applied to the welding tool, the arc’s resistance (or more correctly, the current) 1s 
a measure of the height of the torch tip above the surface that is to be welded. 
Inductive current monitoring is utilized because welding normally produces large 
currents (e.g., 100 to 200 A). 

In the case of gas metal arc welding (GMAW), more commonly called the 
metal inert gas (MIG) technique, a blanket of inert gas (e.g., argon, helium, 0! 
carbon dioxide) protects the welding torch’s electrode, as well as the material _ 
welded, from exposure to the air and, hence, rapid oxidation. The erro 
consists of a wire continuously supplied from a drum. The composition of " 
wire varies depending on the nature of the welding application because the ci for 
metal is used as a filler in the MIG process. It 1s found ¢ . Vis 
this type of welding, the relationship between the arc current J and voltag 


given by 
V=R(h—- LI 


where R = average resistivity per unit length of the electrode wire 


L = arc length 
h = height of the tool tip from the metal surface. P tind 
U 
Normally, V is a constant, so that J is an inverse function of /. Thus, by 4 ound: 
It has bee 


the robot’s position, the arc current can be kept fairly constant. 
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(position) sensing for automated seam 
g application. (Redrawn with permission of G.E. Cook. 


for example, that 
mil change in h. 

The problem of automated seam track 
of the foregoing method (see Figure 5.8.8). 
sing, the welding tool is deliberately moved back and forth a small distance across 
the seam between the two pieces of metal [14]. This action is often called weaving 
and is available as a selectable motion, often with a variable oscillation amplitude, 
on many robots (e.g., a Unimation PUMA 550). If the center of the seam is being 
properly tracked, the arc current at the maximum and minimum points on the 
weave (or oscillation) will be the same. However, if the gun has moved away 
from the seam’s center, these two currents will differ, and this difference signal 
(or error) can be used to realign the manipulator. The vertical height h can also 
be controlled by sampling the arc current at the center of the torch oscillation and 
then comparing this current with some reference value, which has been determined 
in advance (i.e., off-line) and depends on the type of material being welded. 
Again, the difference between the reference and actual currents produces an error 
signal that can be used to readjust the robot’s position above the welding surface. 

A similar seam and height tracking procedure is possible for the other major 
type of arc welding [i.e., the tungsten Inert gas (TIG) process, also mea 
tungsten arc welding (GTAW)]. In addition, other weld oe — 
been developed, but these are usually of the contact variety. We will discuss them 
in a subsequent section when tactile devices are described. 


in the MIG process, J will vary by about 1 to 1.5% for each 40- 


ing has been solved by a modification 
In this through-the-arc position sen- 


5.8.2.7 Other proximity sensors 


‘mi ices described above, a number of others 
i ontact proximity devices ) 
eithe peepee ys or ae been used as external robotic sensors. These 
r hav 


include: 


‘li ircuit to detect changes 
a ich utilize a bridge or oscillator circui 
1. Capacitive probes, which u 
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in capacitance produced by variation in the distance between two Paralle| 
plates [15]. 

Constant charge probes, which measure the height of a ferrite magnetic heaq 
above a rotating magnetic disk by monitoring the change in voltage ACTOsg 
the capacitor formed by these two elements. The capacitor is assumeg to 
have a constant charge [16]. 


3. Air pressure sensors, where proximity sensing is obtained by monitoring the 
change in back pressure produced when an object comes near a jet delivering 
high-pressure air [17]. 

4. Hail effect sensors, where the magnetic field intensity (e.g., produced by either 
permanent or electromagnets mounted on an object) determines the generateq 
voltage output [18]. 
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9-9 TOUCH AND SLIP SENSORS 


Of all the senses that human beings possess, the one that is probably the most 
likely to be taken for granted is that of touch. It is only when a hand or arm is 
amputated that the ability to recognize objects and/or adaptively control the grasp- 
ing force that comes from the human tactile sensory apparatus is truly appreciated. 
It is therefore not too surprising that in the attempt to imbue robots with some of 
the attributes of human beings, developments in robotic vision have outshadowed 
those in the area of touch and slip sensing. 

In the last few years, however, as new and more sophisticated applications 
for robots have been conceived, tactile sensing has been recognized as an extremely 
important machine sense. In the area of parts handling, for example, it has become 
increasingly important to be able to detect any misalignment (i.e., the actual ori- 
entation) of the parts as they are presented to the robot. In addition, it is often 
necessary to know where a part is being grasped by the robotic gripper and whether 
or not it is slipping. Although vision has been used (or proposed to be used) in 
this respect, it appears that tactile sensing may be a less costly and faster (com- 
putationally) solution to the problem.* Also, a major advantage of tactile sensing 
over vision is that it can yield the desired information about part position and 


*Hillis has given three reasons for this [19]: 


1, “There are far fewer data to be analyzed than in a visual image.” eal-tume 


processing is possible. 


2. “Collection [of data] is more readily controlled.” This is the equivalent of analyzin 
scene where the background, illumination, and point of view are optimally adjusted (e.8- 
provide ideal contrast between the part and the background). 

3. ‘“‘Properties that we actually measure are very close, in kind, to 
infer.”’ For example, size and shape can be obtained d 
inferred if a visual sensor is used, 


As a consequence, 


wish tO 


we 
the properties that must be 


irectly for a tactile sensor but 
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orientation within the jaws of the gripper. Moreover, there are many applications 
where the limited resolution/pattern recognition capabilities of a tactile device is 
more than adequate for the desired task. For these reasons, recently there has 
been a significant Increase in research and development in this area both at univer- 
sities and in industry (robotic and otherwise). 

The term tactile sensing does not have a universally accepted meaning. For 
example, Harmon [20] has defined it to be “the continuous-variable sensing of 
forces in an array.” The implication is that the sensor should possess skin-like 
properties and be capable of detecting differing levels of signals and parallel patterns 
of touching. In contrast to this, Harmon refers to simple contact or force sensing, 
whether binary or continuously variable at one, or at most a few, specific points 
as simple touch sensing. However, other researchers have chosen to describe as 
tactile sensors those devices that do produce a binary signal from the active elements 
in the array. That is, thresholding of the signal from an array element is used to 
determine whether contact has been made. It should be noted that just as in the 
case of binary machine vision (see Chapter 6), it is possible to obtain a good deal 
of object recognition information in this instance. Also, because there are usually 
significantly fewer data, processing time is reduced significantly. In this section 
we use this modification of Harmon’s definition. 

In Harmon’s report, he presented the results of a survey of 47 researchers 
and manufacturers in which they were asked to give the desired attributes of an 
‘ideal’ tactile sensor. In summary, he found that what these people wanted was 
that: 


1. Tactile sensors should be compliant and rugged (i.e., durable in the manu- 
facturing environment). 

2. Sensors (i.e., sensory arrays) should be “‘smart,” meaning that they should 
process most of the information before communicating with the robot. 

3. Sensor resolution should be on the order of 100 mils, although some appli- 
cations could require a larger or smaller value. 

4. The sensors should be able to detect forces as low as S to 10 gr, with a dynamic 
range of about 1000 to 1. 

5. Sensor response should be stable (with time), monotonic (and preferably 
linear, although some nonlinearity would be acceptable), and most important, 
not exhibit hysteresis (i.e., be repeatable). 


The prototype experimental and the (few) commercially available tactile sen- 
SOrs meet some but not all of these requirements. In fact, much research and 
development remains to be done before a device exists that will permit a robot to 
lift an egg without crushing it or a block of brass without dropping it when the 
objects are presented in random sequence. | | 

In the first part of this section, we present a number of tactile sensing tech- 
niques that have been used as either simple touch or tactile sensors with varying 
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degrees of success. The second portion of the section discusses severa] Metho 

of slip sensing. : 


9.9.1 Tactile Sensors 


A variety of techniques and materials have been used in an attempt to Produce 
tactile sensor that is sensitive, rugged, and reliable (i.e., meets the requirement, 
listed above). As of this writing, none do this, although a few satisfy some of 
items on the list. We will briefly describe a number of devices that utilize different 
sensing principles. In particular, we discuss an extension of the simple contact 
rod proximity sensor (see Section 5.8.1) to produce a three-dimensional tactile 
sensor. Other devices covered make use of photodetectors, air pressure, con. 
ductive elastomers, or polymers as their sensing elements. The section concludes 
with a description of several tactile arc welding seam trackers. 


9.9.1.1 Proximity rod tactile sensors 


As mentioned earlier in this chapter, certain simple proximity-sensing tech- 
niques can be extended to produce a robotic tactile sensor. An example of this 
[21] is shown in Figure 5.9.1, where the single-contact rod proximity sensor has 
been replaced by an array of such sensors (i.e.,4 x 4 = 16). A possible mode 
of operation requires that the robot wrist on which the device is mounted be moved 
down toward and parallel to the table or other surface on which an object is resting 
(Figure 5.9.1c). Descent continues until the base of the sensor is at a distance 
approximately equal to the length of the sensing rods above the tabletop (Figure 
5.9.le). At this point, mechanical or electrical switches connected to each of the 
sensor rods are checked for closure (i.e., contact). In this manner, a two-dimen- 
sional or binary pattern of the object is obtained. Image processing techniques 
similar to those employed with binary vision systems can be used to provide object 
type, shape, and orientation information (see Chapter 6). An appropriate set of 
actions can then be performed by the robot, [e.g., reorientation of the gripper (if 
necessary) and closing of its jaws]. 

A major difficulty with this technique is that the robot must know exactly 
how far to descend toward the table surface. If it does not go far enough, it is 
possible that not all of the sensing rods will come in contact with the object. 
it goes too far, the table will appear as part of the object. One method of over 
coming this problem is to replace the (binary) switches with elements that measure 
actual distance (i.e., provide gray-level information). With such a modificatio” 
as the sensor moves toward the object, the rods are once again pushed back ode 
the body of the device (Figure 5.9.1d). However, in this case, the robot ane 
descent when all rods have moved a minimum (or threshold) distance, there : 
indicating that the sensor’s elements have come in contact with either the aby 
or the tabletop (Figure 5.9.le). Measuring the distance moved by each of thes 
rods (relative to their starting position) yields a three-dimensional image ° 
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(b) 





(c) (d) (e) 


Figure 5.9.1. Three-dimensional proximity rod tactile sensor: (a) top view; (b) side view; 
(c) sensor descending; (d) sensor in partial contact with object; (e) sensor in full contact with 
object. (Courtesy of W.B. Heginbotham, Nottingham, England. From Page, C.J. and 
Pugh, A., “‘Novel Techniques for Tactile Sensing in a 3-D Environment,” Proc. of 6th Int'l 
Symp. on Industrial Robots, University of Nottingham, England, March 24-26, 1976.) 


object being “‘scanned.’”’ Gray-level image processing techniques similar to those 
employed with vision systems can be used for this purpose (see Chapter 6). 

This procedure has a problem also. Since the rods must be able to move 
quite freely, it is possible that false deflections may be obtained. Spring-loading 
of the rods is possible, but a better solution suggested by the authors is to vibrate 
the tabletop. The robot will then continue to move toward the object until all rods 
are vibrating. At this point, the robot is commanded to stop, the relative rod 
deflections measured, and the object recognition algorithms used to process these 
data. 

Besides the originally proposed switch sensors, a variety of linear measuring 
techniques can be used to obtain the relative rod deflections. For example, the 
authors used rods made of ferrous material. Magnetic detection methods were 
then used to sense distance (see Figure 5.9.2). This was accomplished by causing 
the robot to move vertically (using stepper motors) and looking for a rod to move 
the ferrite cylinder into or out of the sensing coil. (Such an action produced a 
Significant change in voltage across a coil.) The travel distance of each rod could 
be deduced from the instant each one caused a switch. The state of all the matrix 
of switches was continually scanned to determine the appropriate switching pattern 
and length of rod travel. In this manner, the part contour was sensed. In a later 
version of the tactile sensor, it was suggested that each rod be connected to a pot 
[22]. All the comments of Section 5.2.1 concerning the problems of using a pot 
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are pertinent in this respect. Obviously, many of the ned eee seusing Meth. 
ods discussed in earlier sections of the chapter could also” € used. However. the 
more expensive ones (e.g., the LVDT) would not be practical since each rog would 
require a separate position sensor. 


5.9.1.2 Photodetector Tactile Sensors 


Among the noncontact proximity sensors discussed in Section 5.8.2. jt will 
be recalled that one used the “beam break principle.”’ Over the last decade 
several tactile sensors have been developed utilizing this technique [23]. In 1983, 
the Lord Corporation described a commercial device [24] shown in Figure 5.9.3, 
[Actually, only one sensor element is indicated. In reality the sensor Would, of 
course, consist of an array of such elements, (e.g., 8 x 8 for the Lord LTS 109) 
It can be seen that the portion of the sensor that comes in contact with the Object 
to be sensed is covered with an elastomer (a rubber-like material). In addition, 
a piece of this material extends through the sensor structure. Mounted on the 
back of the body of the device is a photo emitter-detector assembly (see Figure 
5.9.3a). When the object comes in contact with the touch surface, if the elastomer 
is compressed a minimum distance, the material extending through the body breaks 
the beam of the photosensor (see Figure 5.9.3b). Obviously, a thresholding circuit 
can be used to provide binary information about the object, that is, whether or 
not each element of a sensor composed of such devices is in contact with a part. 
In a manner similar to that described for the proximity rod contact sensor, two- 
dimensional information about size, shape, and part orientation can be obtained. 

It is also possible to determine information about the relative deflection at 
each array point. In this respect the reader will] recall (from the discussion in 
Section 5.3.2.2) that the voltage ouput from a photodetector varies with the incident 
light intensity. Thus, by monitoring the actual signal from the individual photo- 
detectors, the voltage level can be related to distance traveled by the sensing 
element. Depth (e.g., three-dimensional) information is limited since the overall 
travel distance is quite small. For example, the elastomer used in the Lord LTS 
100 will deflect a maximum of 2 mm. However, the voltage variation at each array 
point can be related to the pressure or force being applied by the robotic grippe! 
Clearly, this is a desirable attribute of such a Sensor. The above-mentioned device 


will sense a force of 1 Ib applied to any single Sensing site at a full mechanical 
deflection of 2 mm. 


At least two potential difficulties 


. j Cir Occur with such a sensor. The first has t0 
do with mechanical hysteresis in the e] 


astomer. This implies that the rubber ™! 


the problem. However, this effect will create Severe problems with a sensor ! al 
is supposed to provide absolute voltage-level information (as is the case with 4 
device that also gives pressure or f | 


Orce data). Th roblem © 
reduced somewhat, however, by the Small ios dttanen ro rs mee 
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(c) 


Figure 5.9.2. The sensing principle of a 64 (8 x 8) element proximity rod tactile 
sensor: (a) single spring loaded ferrite cylinder element, (b) top view of the sensing 
and drive coil configuration; (c) drawing of the actual sensor. (Courtesy of W.B. 


Heginbotham, Nottingham, England. ) 


m with using this type of tactile sensor has to do with 
ronment. Since the elastomeric surface must 


actually come in contact with the object being grasped by the robot, it is quite 
likely that significant wear will take place. This means that unless the rubber is 
ill have to be replaced quite frequently. Depending on 


carefully protected, it wl 
the actual application, this may or may not be an acceptable solution. 


The second proble 
ruggedness in a manufacturing envl 
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ELASTOMERIC 
TOUCH SURFACE 


A 
A 
Nj 


LENS STRUCT URE 
PHOTO EMITTER 
PHOTO DETECTOR 


ZERO DEFLECTION MODERATE DEFLECTION 
(a) 


(b) 
Figure 5.9.3. One element of a photodetector tactile sensor: (a) no load applied 
to the sensor’s surface; (b) a load results in Partial obstruction of the light beam 
from the photo emitter causing a change in the photodetector Output. (Courtesy 
of J. Rebman and the Lord Corp., Industrial] Automation Division, Cary, NC.) 


5.9.1.3 Conductive elastomer sensors 


Elastomers provide varying degrees of compliance and are generally made 
from either foams or rubber (natural 


Or silicon based). The Lord sensor describe: 
in the preceding section used one such elastomer as a deflectometer. Howevel! 


is also possible to imbue many of these materials with interesting electrical properties 


Sip capesasmagy epheysnanit pcg by impr ©gnating them with silver or carbon. en 
this is done, it is found that their regj 


Stance changes as they are deformed (e.8» 
compressed). A number of tactile sensing devices have been developed that utiliz 
this variation in resistance as their a 


; , ‘ 
. ctive elements. One such unit is show” . 
Figure 5.9.4. It is observed that the device has a three-layered “sandwich” st 
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Figure 5.9.4. Conductive elastomer sensor. (Redrawn with permission of W.E. 
Snyder and reused with permission of the original copyright holder, The Institute 
of Electrical and Electronics Engineers, Inc., New York City, NY. From reference 
{25].) 


ture consisting of a sheet of conducting elastomer covered with a protective plastic 
coating. These two parts are placed over a printed circuit board on which 16 pairs 
of concentric ring electrodes have been etched. Thus there are 16 sensing sites 
arranged in a 4 x 4 rectangular array. Groups of four outer ring electrodes are 
connected together (i.e., in parallel) to form the four rows. The columns are 
obtained by first connecting cathodes of the individual diodes to the inner elec- 
trodes. Groups of four diode anodes are then connected in parallel. A single 
fixed current-limiting resistor, connected to a 5-V dc supply, is placed in series 
with each of these groups, thereby completing the row structure. The elastomer 
provides a pressure-sensitive resistive path between the inner and outer electrodes. 
It is important for the reader to understand that the grouping described above for 
a sensor having n < m elements is a practical necessity in a robot application since 
Only (n + m) external wires are then needed for accessing individual array sites. 
This should be contrasted with the situation where every array element has an 
external lead and hence (n X m) wires must be carried in a wire harness that may 
be subject to severe twisting motions during normal robot operation. 

The method of determining which element (or elements) in the sensing array 
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Figure 5.9.5. Row-column decoding (2 x 2 array) of the conductive elastomer 
sensor in Fig. 5.9.4. (Redrawn with permission of W.E. Snyder and reused with 
permission of the original copyright holder, The Institute of Electrical and Elec- 
tronics Engineers, Inc., New York City, NY. From reference [25].) 


is in contact with an object can be understood by considering the simplified 2 * 
2 array row—column “‘decoding logic’”’ circuit shown in F igure 5.9.5. The extension 
of this circuit to larger ones is straightforward. Suppose that only a single array 
point is being compressed. A row of electrodes is “selected” by causing one group 
of outer rings to be grounded. For example, the correct 2-bit code applied to the 
Select lines of a 74156 will cause the leftmost output transistor to be on and al 
the others off. Row 1 is enabled, and as a result current will flow from the inne! 
to the outer ring for each of the two elements of this row (i.e., through Rn 4 
Rj). Ina similar fashion, the proper 2-bit code to the Select inputs of the 7415> 
causes either the voltage at point A (V,) or B (Vz) to appear at the Analog Out 
terminal (i.e., column 1 or column 2 to be decoded). Note that the diodes are 
required to prevent “cross talk” between adjacent elements in the array ff" 
occurring. 

If neither of the elements is the one in question, the voltages at points A and 
B will be almost equal. However, if one of these elements is being compressé 
(e.g., the one in row 1, column 1), R,, will be different from R,, and so Va and 
Vz will also differ. For example, if the resistance of the elastomer decreases ® 
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the material 1s compressed, R,, will be smaller than R,, and V,, will be less than 
VB: The use of appropriate thresholding circuitry will convert this information 
into a binary format which can be used for object recognition. However, force 
and/or pressure monitoring from such a device would require the utilization of the 
voltage levels. Note that in some respects the enabling of the rows and columns 
of this sensor is similar to decoding of a computer keyboard. 

| An experimental sensor that also uses a conductive silicon rubber but in a 
different way has been described by Hillis [19]. The device also has a sandwich 
structure. However, unlike the previous one, the printed circuit has etched on it 
a set of parallel line electrodes, implying that conduction is in only one direction. 
The active element used is anisotropically conductive silicon rubber (ACS), which 
is conductive only along one axis in the plane of the sheet. The PC board and 
elastomer sheet are mounted so that their individual conduction directions are at 
right angles. The intersection of each of the contact points of the two sets of 
conductors forms the separate sensing elements. 

As shown in Figure 5.9.6, a separator (either made of a fine-mesh nylon 
stocking or formed from a nonconducting paint) is placed between the PC board 
and the ACS. With no pressure on the sensor, the ACS does not touch the gold 
electrodes on the PC board (Figure 5.9.6a). As the pressure is increased, the 
contact area between the ACS and the electrodes increases (Figures 5.9.6b and c). 
Since the contact resistance is inversely proportional to the contact area, the larger 
the pressure, the smaller this resistance. Row and column decoding is accom- 
plished using a scheme similar to the one described above. 

Several problems exist with these sensors. One of the major ones is that the 
elastomeric material has a limited life. It has been found that after a relatively 
small number of operations (e.g., hundreds), the material begins to deteriorate 
and cracks develop. In addition, attempting to grasp objects with sharp corners 
will also damage the elastomer. In either case, the electrical properties are sig- 
nificantly changed, and eventually the sensor is rendered useless. The only remedy 
is to replace the active material, which may not be acceptable (because of system 
downtime) in some processes. . 

Another major problem with many elastomers 1s that they exhibit significant 
hysteresis. This means that the array resistances (e.g., Ru, Ri», Ro, and Ro» in 
Figure 5.9.5) do not return to the values before compression occurred. Unless a 
“calibration” is performed before each use, repeatability can be greatly affected 
by this situation. Even for those elastomers that do not exhibit a permanent 
hysteresis, these materials often require a long time to return to the uncompressed 
resistance value. Thus unless there is sufficient time permitted between uses, there 
will still be a hysteresis-like effect. As of this writing, the Barry Wright Company, 
which has produced a commercial touch sensor that utilizes a conductive elastomer, 
has stated that it is currently developing special compounds that will reduce or 

h conductive rubber tactile sensors. 


imi iated wit 
eliminate many of the problems associa : 
If successful al ae will no doubt become commonplace in the manufacturing 


environment. 
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Figure 5.9.6. Anisotropic conductive rubber (ACS) sensor. Views at the right 
rea between the rubber and the gold e 
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Figure 5.9.7. IBM pneumatic switch sensor. Each of the fingers of this experi- 
mental end effector has 100 pneumatic switches. (Redrawn with permission of 
the IBM Corp., Purchase, NY. From reference [26].) 


Figure 5.9.7). An exploded view of two of these switches is shown in Figure 5.9.8. 
The entire sensor is covered with a flexible “‘skin’”’ whose purpose is to increase 
the friction between the walls of the gripper and the object being grasped (e.g., a 
peg). In addition, it is important that this skin (or covering) electrically insulate 
the part and the gripper. Some form of nonconducting flexible rubber or foam is 
Suitable for the application. Underneath the covering, a thin metal sheet (or 
diaphragm) is secured to the sensor’s solid body. With nothing inside the gripper’s 
Jaws, a source of pneumatic (or liquid) pressure keeps the diaphragm pressed 
against the skin. However, the gripping of the peg, for example, will cause a force 
(F, or F,) to be applied to a number of switch locations. If the force at any of 
the sites is large enough to overcome the applied pressure, the diaphragm will snap 
to the inward position as indicated by the dashed lines in Figure 5.9.8. This will, 
in turn, allow the diaphragm to come into contact with the fixed electrode, thereby 
completing the electrical path (i.e., closing the switch at that particular site). The 
metal sheet will return to its original position (switch open) when the external force 
IS removed due to the internal pressure. 

It is clear from this discussion that such a sensor will be strictly binary in 
nature. However, the actual force exerted on any part can be varied somewhat 
by preprogramming the amount of internal pressure and stopping the motion of 
the gripper’s jaws when any single switch is activated. Sheet dimensions and 
material type also affect the force required to close the switches. 

Although some binary pattern recognition is also possible with the sensor, the 
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Figure 5.9.8. Exploded view of two elements of the pneumatic switch sensor shown 
in Fig. 5.9.7. The thin metal diaphragm is in position A if the force F, is below some 
threshold whereas it is in position B if the threshold is exceeded. (Redrawn with 
permission of the IBM Corp., Purchase, NY. From reference [26].) 


experiment that was actually performed involved the attempted insertion of a peg 
into a hole. The peg was placed within the gripper’s jaws and moved to the 
approximate hole position. The air pressure was set high enough so that the act 
of grasping the peg caused no switches to be closed. The (binary) distribution of 
forces (switch closures) caused by any misalignment of the peg in the hole was 
sensed, processed by the computer, and this information used to modify the grip- 
per’s orientation so as to facilitate insertion. It is important to understand that 
since the manipulator has little or no compliance, any misalignment of the pte 
with the hole would normally prevent insertion. 

Despite the promising nature of the pneumatic sensor, IBM did not continue 
its development. The most likely reason was its rather limited dynamic rang® 
(i.e., 0 to 50 gr). 


5.9.1.5 Polymer tactile sensors 


Piezoelectric materials have been considered as another possible active ele 
ment in a number of experimental tactile sensors for robotic applications. net 
property that makes them potentially attractive is that they generate a voltage 
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their dimensions are altered. Of the man 

olymer polyvinylidene fluoride, referred 
has been most extensively used. The maj 
even in the thin sheets used for the sensin 
of producing large voltages for extremel 


A thin sheet of PVDF (e.g., 28 4m thick) can be considered as a capacitor 
when it has electrodes on both of its surfaces. If a pattern of such electrodes is 
deposited directly on the PVDF film, the developed charge at the compressed 
sensing point will flow through the cross section of the particular row and column 
electrodes which make up the Capacitors. It is important to understand that the 
PVDF is capable of producing an Output when it is either compressed (the “direct 
mode”’) or caused to bend (the “stretch mode”’). For thin films, the latter mode 
has far better sensitivity (i.e., large response for small sensor deflection). 

One characteristic of PVDF is that when bending takes place, the developed 
output is transient in nature. That is, the charge will ‘‘leak’’ off the capacitor, 
causing the voltage eventually to return to zero. Fortunately, the time constant 
of this behavior is on the order of many seconds so that detection of the maximum 
signal is not too difficult. Sensors utilizing this material obviously can only monitor 
changes in force (or pressure). 

Another important property of PVDF is that is is pyroelectric in nature. That 
is, changes in temperature will produce a voltage response, and as a consequence 
extremely sensitive fire detectors have been built to take advantage of this behavior. 
It is possible that a robotic sensor could be constructed based on the pyroelectric 
effect, and in fact one has been proposed [27]. _ However, it is extremely likely 
that such a sensor would be of the proximity type because poor resolution would, 
no doubt, limit its ability to yield tactile information. Alternatively, it could be 
combined with another class of sensor to provide the desired tactile data. It is 
important to note that any sensor based on the piezoelectric effect would still be 
sensitive to changes in the temperature of the objects being grasped by a robotic 
gripper. In addition, changes in the ambient temperature itself will also cause 
PVDF pyro-generated voltages, although this is not a problem because these var- 
lations tend to occur over long periods of time. 

As mentioned, most of the work toward developing a PVDF tactile sensor 
Is experimental in nature. For example, a major effort is currently under way at 
Carnegie—Mellon University, where a 4 x 4 prototype has been constructed and 
tested. Also, at the Centro “E. Piaggio’ at the University of Pisa, Italy, an array 
of16 x 16 circular sensing elements has been used as a binary (i.e., “‘simple touch’’) 
Sensor to yield information about position, orientation, and shape of a part [28]. 
The device depicted in Figure 5.9.9 uses a sheet of PVF2 that is 100 wm thick. 
The Sensor is rugged, low in cost, and sensitive. However, there are difficulties 
with circuit reliability and EMI. . _ 

Another project, under the direction of one of the authors, involved the joint 
Participation of U.S. Robots, Inc., Temple University, and Drexel University. The 


y such materials that are available, the 
to as either PVF2 or PVDF, is one that 
Or reasons are that it is extremely rugged, 
g application, and very sensitive, capable 
y small mechanical deformations. 
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Figure 5.9.9. A 16 x 16 element PVF2 binary tactile sensor. (Redrawn with 
permission of P. Dario. From reference [28].) 


design of a prototype sensor is shown in Figure 5.9.10. Here it can be seen that 
a multilayer sandwich structure is utilized. A protecting sheet (of nonconducting 
plastic, for example) is used to cover the film of PVDF. Metallization of the 
polymer is performed to produce the sensor’s row electrodes. Layers of noncon- 
ducting silicon rubber are used to provide a certain amount of compliance and to 
prevent current from passing through any uncompressed sensing points. A PC 
board containing the column electrodes also provides mechanical stability to the 
overall package. At acompressed sensing location, the conductive rubber element 
contacts the column electrode so that any developed charge caused by deforming 
the PVDF can be read out. _ 

A major concern with this design is the potential difficulty of anna: 
manufacturing such a unit. Another problem (which is common to all such era 
involves crosstalk, whereby uncompressed elements will appear to be —" ‘ 
because of a closed loop of capacitors. A possible solution is to utilize a ge 
multiplexing chips on board the sensor itself. The use of diodes does not ne 
to be feasible here (see Section 5.9.1.3), due to the large capacitance east 
to that of each sensing site) introduced by these elements. Even the wa? : 
may not completely solve this problem since they also have a certain oe come 
capacitance (e.g., on the order of 5 Picofarads) which could still oe s quite 
crosstalk to occur. Finally, one last difficulty with PVDF sensors is that y) Silk: 
important to control the thickness of the bonding material used (e.g-, €POXY”” 
screen techniques seem to be applicable in this case. 
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Figure 5.9.10. Tactile sensing device utilizing PVDF. A multilayered sandwich 
configuration also employs both conductive and nonconductive rubber. (Courtesy 
of U.S. Robots, Inc., Temple University, and Drexel University.) 


5.9.1.6 A hybrid tactile sensor 


The prototype sensor shown in Figure 5.9.10 actually employs both PVDF 
and a conductive rubber. It can therefore be considered to be a “hybrid device. 
However, the conductive rubber is not used because its resistance varies with the 
applied pressure. Instead, this material provides a compliant contact that permits 
the developed charge to be sensed. There is, however, a true hybrid experimental 
‘ensor that has been developed at Bonneville Scientific. The prototype unit bee 
scribed by Grahn and Astle has 12 array elements with a 1-mm resolution [30]. 
It was reported to be able to detect pressures ranging from 0.15 to 300 psi (1.e., a 

-1 dynamic range). 

This device is essentially ultrasonic 
€ttles of both PVDF and silicon rubber in its des 
Ol the sensor, consider the array construction > 


ic in nature, but it does utilize certain prop- 
ign. To understand the operation 
hown in Figure 5.9.11. Here the 
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Figure 5.9.11. Array construction and principle of operation of an ultrasonic 
hybrid tactile sensor. The time for a reflected pulse to be sensed is related to the 
silicone rubber pad thickness and hence to the applied force. (Courtesy of L. 
Astle, Bonneville Scientific, Salt Lake City, UT. From reference [30].) 





PVDF is used as an ultrasonic transducer that generates pulses of ultrasonic energy 
(see Section 5.8.2). This is accomplished by applying an electric field to the 
polymer, which causes it to mechanically deform. Nonconducting silicon rubber 
is placed over this transducer and used not only to protect it but also for compliance. 
However, the major role played by the elastomer pad is to provide a path for the 
incident and reflected acoustical (ultrasonic) wave. The pad thickness can be 
determined by monitoring the time for a reflected pulse to return to the receiver. 
If no object is being grasped, it will be t%. However, the compression of the pad 
will reduce this time to 4; (<f). An(n X m)-element array of such sensors will 
provide some information about the size, shape, and orientation of the object using 
pattern-recognition techniques. In addition, ifthe relationship between the applied 
force as a function of the pad’s compression is known a priori, it is also possible 
to obtain information about the actual force from the thickness data. 

A similar prototype ultrasonic sensor utilizing PVDF was tested by Rossi ¢t 
al [27]. Such a device was combined with the polymer tactile sensor mentioned 
above. Results of this work are quite preliminary. 

Clearly, this class of sensor has a number of potential problems. The major 
ones involve the effect on object shape and applied force determination due ' 
changes In the silicon rubber S acoustic properties. These result from a variety of 
causes, which include aging, temperature variations, fatigue, and improper US 
(1.e., sharp edges on objects being grasped). It is important to understand that 
anything that modifies the round-trip travel time of the sonar pulse in a nonpr™ 
dictable manner will create an error. 
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5.9.1.7 VLSI-conductive elastomer sensor 


ne of the desired attributes of ac 

ie. o, i tnost of the signal/data aicadar ced ne sensor is that it be ‘“‘smart”’ 
nication to the robot controller is made). One aeieieamaed wen Sueno 
19 do this has been developed by Raibert at Carnegie—Mellon Unit nig 9 
shown in Figure 5.9.12 [31]. In essence, the top portion of the VLSI chi os : 
thin layer of glass insulation into which an array of holes has been stata AS 
pressure iS applied to the device, the conductive elastomer comes in contact with 
, set of aluminum electrodes that lie beneath the glass. Embedded still further 
under this sandwich of sensing elements are a set of “local processors” which 
erform the appropriate deformation and pressure determination. This is accom- 
plished by comparing the sensed current flowing between the electrodes and the 
elastomer with a small “‘test current.” 

Recently, a 3 xX 6 element device has been built that has a sensing area of 
about 1 mm*. A major problem with the use of VLSI technology is that it is not 
now possible to produce such chips that are 100% defect free, that is, where all 
of the sensing sites are working. A possible solution to this dilemma is to utilize 
redundant design in the chip, thereby allowing for multiple computing elements at 
each sensing site. In addition to this difficulty, all of the problems with conducting 


elastomers that were described previously are still of concern. 


5.9.1.8 Optical tactile sensors 

6 is devoted entirely to the important topic 
of robotic machine vision. However, several newly developed tactile devices utilize 
optical techniques. In fact, we have already described one device that utilizes an 
array of photodiodes and photodetectors to obtain tactile information (see Section 
5.9.1.2). In this section we discuss two sensors, one based on light traveling 
through an acrylic plate and the other on arrays of optical fibers. 

British Robotic Systems of London, England, with the assistance of the Uni- 
versity College of Wales (Aberystwyth), has developed a high-resolution tactile 
sensor that utilizes light conduction through a light pipe and a charge-coupled 
device (CCD) imaging system. As shown in Figure 5.9.13, the device consists of 
a compliant membrane which is separated by a small air gap from a light guide 


made from a piece of clear acrylic [32]. With the membrane undeformed, light 
ost total reflection at the air/acrylic bound- 


entering from the left side undergoes alm - 
ary. Asa result, little, if any, light reaches the CCD imager (see Figure 5.9.13a). 
However, if a part is placed on the sensor, aS indicated in Figure 5 .9.13b, the area 
where the membrane touches the acrylic will cause light to scatter. Some of the 
Scattered light rays will incident the opposite surface of the acrylic : - angle that 
Permits the rays to pass through the guide. They are then focuse s o an array 
of CCD devices in a manner similar to that employed in solid-state v1 a hamper 
Standard optical mage processing techniques can be used to na os pn ure 
Of the object. In addition, since the intensity of the reflected light (1.e., egree 
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Figure 5.9.12. VLSI-conductive elastomer tactile sensor: (a) physical layout of 
the device; (b) side view—no applied force; (c) side view—an applied force reduces 
the resistance by an order of magnitude; (d) electronic sensing circuit for one 
element. (Courtesy of M.H. Raibert. From reference [31].) 
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Figure 5.9.12. (continued) 


of scattering) is approximately proportional to the pressure on the membrane, a 
sensor made in this way is capable of producing force information. 

A prototype device has been constructed that measures about 0.64 in. by 1 
in. Within this area, there are currently 64 x 64 (4096) individual sensing points, 
which provides extremely fine resolution (perhaps much more than is actually 
required, in fact). It is reported that an array of 256 x 256 points is also quite 
feasible. In the initial experiments, two such sensors have been placed on the 
fingers of a parallel-jaws gripper. Information provided from the devices has been 
processed and displayed on a video monitor. Eventually, however, it is to be 
expected that these data will be used in a detection and force feedback scheme. 
It is clear that this scheme offers the possibility of producing a rugged tactile sensor 
that can be used in a manufacturing environment. 

The second optically oriented tactile device is currently being developed at 
MIT under the direction of T. B. Sheridan and J. L. Schneiter. The first prototype 
unit that they built utilized 34 layers, each containing 35 optical fibers, which were 
individually epoxied together. The fibers in every other layer acted as receivers, 
whereas those in the remaining ones were emitters. A white silicon rubber “‘skin” 
was used and provided compliance and even more important, a light-reflecting 
surface. With nothing pressing against the sensor, each of the receiving fiber optic 
bundles collects light from the various emitting layers. The output of these re- 
ceivers is sensed by a standard TV camera and then digitized for subsequent pro- 
cessing. This represents the ambient or quiescent signal level from the sensor. 
When something presses on the rubber skin, reflected light picked up by the fiber 
bundles increases in those areas of the sensor that are in contact with the object. 
This occurs because the distance between the reflecting surface and the receiving 
layers is decreased, thereby reducing the amount of scattered light. Consequently, 
there is a change in the ambient signal level which can easily be determined digitally. 

A second prototype based on the identical sensing principle utilizes the same 
fiber as both an emitter and a receiver. This is accomplished through the use of 
a beam splitter. In addition, there are only 25 layers, each having 26 optical fibers. 
In either unit, a major advantage of this approach is that it is possible to achieve 
high resolutions because of the ease with which fiber optic bundles can be “stacked.” 
In fact, Sheridan has stated that densities of up to 2100 sensing points per Square 
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Figure 5.9.13. Acrylic light guide and CCD imaging sensor. The focusing ar- 
rangement is not shown: (a) input light undergoes total internal reflection when 
the compliant membrane is not deformed; (b) a force applied to the membrane 
causes light to scatter. This scattered light is focused and collected by the CCD 
array. [Reprinted and modified with permission of Electronic Design, Vol. 33. 
No. 3 (Feb. 7, 1985). Copyright 1985 Hayden Publishing Co., Inc Hasbrook 
Heights, NJ.] oo 


inch are possible. Note that the British device described above has an even higher 
resolution. 


5.9.2 Robotic Arc Welding Sensors 


An important robotic application is that of arc welding. It will be recalled tha! 
there exist a number of special-purpose robots that do iGthin but this particu 
task (e.8., the Unimation Apprentice). However it is also ossible to utilize ° 
a programming option that is available on chee robots to peror 
such a job. 
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Regardless of which type of robot is employed, a real problem often en- 
countered is that the programmed path may not conform exactly to the actual path 
required in order to produce a good weld. Such a situation can occur because of 
part misalignment or due to small dimensional variations in castings. Conse- 
quently, there is a need for a sensor that can be used to inform the robot when 
these paths differ, and hence permit some degree of repositioning of the welding 
tool to be implemented ‘“‘on the fly.” We have already described a noncontact 
technique whereby the seam was tracked by monitoring the arc current at the 
maximum and minimum points of tool-tip travel in a direction transverse to the 
actual weld curve (see Section 5.8.2). 

Also, a number of contact sensing methods have been developed for this 
purpose. Although these devices do not provide much information about the 
nature of the object being welded, they do yield enough data to permit high-quality 
welds to be made. In addition, of all the external sensors in use today on robots, 
those utilized for seam tracking are probably the most advanced.* 

In this section we consider a number of such devices. It is interesting to note 
that the contact techniques to be described here were developed in Yugoslavia, 
whereas the noncontact procedure introduced in Section 5.8.2 is American, having 
been developed by Cincinnati Milacron. 


5.9.2.1 Simple active optical seam tracker 


A technique of active seam tracking that was introduced in 1981 is shown in 
Figure 5.9.14 [33]. The device works in the following manner: The needle of the 
touch sensor is initially placed in the seam to be welded by commanding the robot 
to lower the tool-sensor assembly until contact is made with the metal surface. As 
welding commences, the manipulator begins to move along the preprogrammed 
path. Any discrepancy between this and the actual seam results in the sensor 
needle being displaced in a direction transverse to the seam. A special optical 
sensor located inside the body of the seam tracker detects this motion and provides 
the necessary error signal to the robot controller so as to permit modification of 
the programmed path. 

The details of the special optical sensor, used in conjunction with the passive 
seam tracker, are shown in Figure 5.9.15. It can be seen that this sensor consists 
of a set of six photoemitters (LEDs) and photodetectors (photodiodes) together 
with a Gray code mask and slit assembly. When the needle is first placed in the 
Seam, the narrow viewing window provided by the slit yields a particular 6-bit 
binary “word” which can be noted or stored in memory (i.e., calibration phase). 
By periodic sampling of the photosensor outputs (i.e., the binary word), the de- 
viation from the initial position can be determined as the needle moves transverse 
to the seam. Since six bits are used, 64 different positions can be sensed using 





*This will, no doubt, change in the next few years as more effort is expended on the development 
M Other areas of robotic sensing. 
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Figure 5.9.14. A simple active optical Figure 5.9.15. Optical sensor used in 
arc welding seam tracking sensor. RH the active optical seam tracker shown in 
= robot hand, TS = tracking sensor, | Figure 5.9.14. (Reproduced courtesy 
WG = welding gun, and S = seam to of S. Presern, University of E. Kardelj, 
be welded. (Reproduced courtesy of S. Jozef Stefan Institute, Yugoslavia. 
Presern, University of E. Kardelj, Jozef From reference [33].) 


Stefan Institute, Yugoslavia. From ref- 
erence [33].) 


such a scheme. Positional resolution for the s 
mm. It will be noted that this device is actual 
Section 5.3.2.2). 


ystem is reported to be about 0.5 
ly a form of “linear encoder” (see 


It is important to realize that because of the extremely high level of EMI present 
in the vicinity of a welding sensor [due to large arc currents (e.g., 100 to 200 A)], 
processing errors are possible. The use of an optical detection system rather than 


one based on induction principles, and Gray code, instead of a conventional binary 
code, minimizes the probability of Sensing errors. 


9.9.2.2 Passive seam tracking sensor 


One of the difficulties with the 
cannot be used to monitor path variati 


metal being welded has a different contour from that originally programmed, it 1S 
possible that the sensing needle wil] either move out of the seam or be driven dow? 


with enough force to damage the detector. Springs could, of course, be used 
prevent this from OCCcuITINg to some extent. However, where fairly large variations 
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can occur, it 18 important to be able also to monitor the needle’s actual vertical 
osition. 

A simple passive device that permits this to be done is shown in Figure 5.9.16. 
The sensor utilizes two LVDTs to detect variations in height (z) and one direction 
transverse to the seam (either +x or —x but not both). The needle is guided by 
the seam itself (i.e., “Passively” with the springs helping in this respect) [34]. 

In actual use, the signals from the LVDTs are sampled periodically. When 
the needle is first placed in the seam, any change in their initial (or calibration) 
value is used as an error signal, which causes the robot to reposition the welding 
tool. A sensor utilizing these detectors has a positional resolution that is dependent 
on the resolution of the LVDT employed. Typically, this would be much finer 
than the one described in the preceding section. | 

| This type of arc welding sensor has the advantage of being fast, accurate 
fairly robust, and relatively simple. However, there are also a number of problems. 
The major one is that, as can be seen from Figure 5.9.16, the device is one-sided. 
Thus it 1s necessary to rotate it in order to sense deviations from the taught path 
that are on the opposite side of the seam. Since it is not always possible to predict 
which way such variations will occur, this can create difficulties. A second problem 
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Figure 5.9.16. Simple passive arc welding seam tracking sensor with two degrees 
of freedom. (Reproduced courtesy of S. Presern, University of E. Kardelj, Jozef 
Stefan Institute, Yugoslavia. From reference [34].) 
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The reader will recall that one characteristic 

o changes in temperature (see Sectig = these 
ht be required in order to prevent tem 3.2.6 | 
osition errors and hence poor weld te 


is with the LVDT itself. 
detectors is that they are sensitive t 
Periodic recalibration of the unit mig 


related calibration drift from causing P 
last difficulty with such a sensor comes from the requirement that the needje . 
Ust 


be in contact with the seam. This produces added drag (i.e., friction) and theref 

increased torque must be supplied by the robotic actuators. Moreover, the a ‘ 
friction will also cause the tip of the needle to wear. A simple solution to “ 
problem is to employ a small ball on the end of the needle. Is 


seam tracking sensors 


ociated with the passive seam tracker discusseq 


in the preceding section, the same Yugoslavian group of researchers developed g 
sensor that overcame most of its difficulties [34]. With regard to Figure 5.9.17, 
the reader will observe that the device is active because it has the means by which 
the sensing needle is moved. That is, it does not depend on the seam itself to 
produce needle motion, unlike the two other detectors described above. A 9.8- 
W micromotor weighing 180 gr periodically lifts the needle out of the seam and 
then back into it, thereby reducing drag on the overall system. The rate at which 
this is done is about 10 Hz, although the frequency can be increased if a complex 
path is to be followed. A piezoelectric crystal is used to determine when the 
needle is contacting the seam. The signal from an LVDT is sampled at this instant 
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and provides a measure of the z-position. To compensate for unforeseen varations 
in the metal surface’s height, a small de servomotor is also employed to keep the 
average z-position of the sensor near enough to the seam so that the micromotor’s 
action permits the needle always to touch the welding surface. X and y displace- 
ment of the sensor is accomplished by selectively energizing a set of coils, which 
in turn attracts the appropriate magnetic core. (This action is similar to that of a 
solenoid-activated relay.) Position is monitored using the capacitive plates shown 
in the figure. 

The ability to drive the sensor element in the x- and y-directions is especially 
useful in cases where there are large seam gaps. The data obtained in this instance 
can be used to increase the weave amplitude of the robot, thereby permitting the 
wider seam to be “‘filled.””, Another advantage that this active seam tracker has 
over the other two welding sensors described previously is that it is less troubled 
by rough seams/surfaces. This is due, primarily, to the discrete rather than con- 
tinuous nature of the sensing method employed. 

The major problem with the active, nonoptical, arc welding sensor is that in 
the sometimes less-than-ideal manufacturing environment, dirt tends to fill the 
space between the capacitor plates. This can create x- and y-direction measure- 
ment errors. One solution to the difficulty is to clean the sensor periodically. 
Another might be to seal it hermetically, although the authors do not suggest such 
a technique. 


5.9.3 Slip Sensors 


One of the capabilities of the human hand certainly taken for granted is its ability 
to determine when an object that is being grasped is slipping. The biological 
control system associated with the hand utilizes the inputs from the appropriate 
slip receptors and causes the gripping force to be increased or decreased, as the 
case may be. Machine determination of slippage of a part or object when in the 
grasp of a robot or other electromechanical ‘“‘hand”’ is still in the experimental 
stage. Of all the ‘“‘external” robotic senses, slip detection is perhaps the least 
developed, and in fact, much of the research in the field has been oriented toward 
prosthetic applications. It is the firm belief of the authors, however, that this 
situation will change. Most certainly, in the next few years, as more complex and 
sophisticated assembly applications become commonplace, it will be necessary to 
detect slip rapidly and to adjust the gripping force ‘‘on the fly” to prevent the part 
from being damaged in a fall. a ost 

Perhaps the simplest way to determine if a part Is slipping (or has not been 
properly grasped) is to use what is often termed the lift-and-try technique (see 
Figure 5.9.18). This entails using the motor current of a particular joint or set of 
joints on a robot as a measure of whether or not a part is slipping. In this respect, 
current monitoring can be performed either digitally or in an analog manner. 
Regardless of which technique 1s employed, the gripper |s first oriented correctly, 
next placed over the particular part, and then a certain minimum grasping force 
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gripper is loaded. 


Figure 5.9.18. Lift and try technique for slip detection. 


applied.* As the manipulator attempts to lift the object in question from the surface 
(e.g., a pallet, table, or conveyor) the motor current in one or more joints should 
increase due to the added load torque. If no increase is detected, the manipulator 
is commanded to return to the starting point. The force is then incremented by 
some predetermined amount and the robot “tries again.” The procedure is re- 
peated until the monitored joint current does increase, at which time it is assumed 
that the part is not slipping and is properly grasped. | 
There are obvious difficulties with this technique. The first is that even if 
the part is successfully raised above the resting surface, there is no guarantee that 
it will not slip out of the gripper as the manipulator moves. If, in fact this occurs, 
the procedure outlined above will not detect the slippage while the robot is i" 
motion. A second problem is that if a fragile part is to be lifted, the minimum 
applied gripping force should be small, to avoid crushing. On the other ap: @ 
heavy, more robust part could easily handle a larger initial force. If the mix ee 
order of parts to be lifted were not known a priori, it is possible that either dam ml 
could be done to some or that it would take far too long to acquire others. ~ 
last difficulty with the technique is that monitoring motor current is not yn 
error free. Care would have to be taken to prevent spikes due to brush 0 





e that as of 


“This assumes that the gripping force can be controlled. It is important to realiz pecte 


° . e acne o ° x 
this writing, few if any commercially available grippers have such an ability. However, it is € 
that as more sophisticated sensors are developed, this situation will change. 
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from being mistaken as a current above the “‘lifting threshold.” Obviously, the 
use of brushless motors would reduce this problem but would increase the cost, 
due to the need for electronic commutation. 

In addition to the lift-and-try procedure, a number of experimental devices 
based on optical, magnetic, or conductive sensing techniques have been developed. 
We now describe briefly several of these slip detectors, which were proposed by 
groups working in Japan and Yugoslavia. 


5.9.3.1 Forced oscillation slip sensors 


In 1972 a group of researchers working at the Nagoya University in Japan 
reported on a number of experimental devices that were developed for detecting 
the slippage of an object being held by a robotic gripper. A variety of sensing 
techniques were employed. For example, “‘forced oscillation’ was used whereby 
any translation of the part in a direction tangential to the surface of the gripper 
jaws (i.e., orthogonal to the direction of the applied gripping force) caused a short 
burst of voltage (i.e., a “‘spike”’) to be generated. One method of accomplishing 
this is shown in Figure 5.9.19 and is very much like that used to play back signals 
recorded on a (analog) phonograph record [35]. 

Here a sapphire needle protrudes from the surface of the sensor and is in 
contact with the object being grasped. If the part begins to slip, the needle will 
be displaced and will produce mechanical deformation in a piezoelectric crystal 
(e.g., Rochelle salt). The resultant generated voltage spike can be sensed using 
a threshold detector and the gripping force increased incrementally until the part 


stops slipping. 
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There are a number of difficulties with this type of slip sensor. The Major 
one is that, although the rubber damper shown in the figure makes the device Jeg 
sensitive to non-slip-related motions, the unit still tends to respond to mechanical 
vibrations of the robot manipulator itself. It is important to note that such , 
detector must be able to sense slippage accurately while a part is being moved 
Thus it is necessary to reduce as much as possible this sensitivity to non-slip-related 
motions. Another obvious disadvantage of the sensor described above is that the 
needle must move against the surface of a part in order to detect slip. This will 
cause eventual wear, meaning that periodic replacement of the needle will be 
required (just as in the case of the phonograph stylus). Finally, the entire device 
tends to be easily damaged if it is dropped or rapidly decelerated (also like a 
phonograph pickup cartridge). 

The unit shown in Figure 5.9.20 incorporates a number of improvements 
which eliminate most of the difficulties described above [35]. In particular, the 
sapphire needle has been replaced by a more robust steel ball (0.5 mm in diameter). 
The fragile crystal transducer has also been eliminated and in its place a permanent 
magnet—coil arrangement is used. Any motion of a part along the gripper’s jaws 
will cause a mechanical displacement of the coil which will, in turn, produce 4 
voltage output. Again, the use of dampers (both rubber and oil) and thresholding 
circuitry will reduce the sensitivity of the sensor to manipulator vibrations. 


5.9.3.2 Interrupter-type slip sensors 


The same Japanese research group also developed additional prototyP¢ slip 
sensors using two technqiues borrowed from other types of sensors [€-8-> a 
(or magnetic) encoders or interrupters]. One such detector is shown in Figy 
5.9.21. This device consists of a rubber roller that protrudes above the — 
surface and contains a small permanent magnet. Any slip of the part 10 vet 
gripper’s jaws will cause roller rotation. As the permanent magnet passes ° 
the magnetic sense head (e.g., one used in a tape recorder can be employe’ 
pulse is generated and the gripping force can be increased accordingly- 
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Rubber Roller 


Magnet 
Magnetic Head 


Figure 5.9.21. Magnetic roller type slip 
sensor. (Redrawn with permission of 
IIT Research Institute, Chicago, IL. 
From reference [35]. 


A major disadvantage of this technique is that the slip “‘resolution”’ is not 
good. It can be seen from Figure 5.9.21 that if the sensor is not placed initially 
in a “reset” position (e.g., magnetic section of the roller over the read head), it 
will take some fraction of an entire rotation before any slip is detected. Even if 
the reset position is used to begin with, so that slip will then be detected as soon 
as almost any rotation occurs, further slip will not be sensed until one additional 
roller revolution occurs. 

A possible solution to the resolution problem would be to use a number of 
magnets rather than one. These elements might also be replaced by small pieces 
of ferromagnetic material symmetrically embedded around the circumference of 
the rubber roller. In addition, the “read’’ head would consist of a simple dc 
energized coil. In this case, part slippage would cause a change in reluctance (and 
a corresponding voltage pulse at the terminals of the coil) after only a small fraction 
of a full rotation. Continued slip would also be sensed in this manner without 
having to wait for a complete roller revolution. 

A second interrupter-like device uses optical rather than magnetic detection 
(see Figure 5.9.22). In this instance the rubber roller of the previous sensor has 


Finger 
Lamp 
= = «CSI 
( = Figure 5.9.22. Optical interrupter type 
Sha ee slip sensor. The photoemitter-detector 
assembly consisting of the lamp, slit, 
and photo-electric cell is shown in detail 
at the right. (Redrawn with permission 
rites of IIT Research Institute, Chicago, IL. 


Roller From reference [35].) 
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a small slit placed in it. A photoemitter—detector assembly is emplo 

any part motion. Clearly, the device has the same resolution difficult d to deteg, 
above. Again, an obvious way to increase the resolution would be y as describe, 
Slits in the roller. i Place MOre 


5.9.3.3 Slip sensing “fingers” 


In addition to the slip sensors described above, the same research 
attempted to model the slip detection capabilities of the human hand by me also 
neurons with pressure sensors (see Figure 5.9.23). One type of pressure tra ea 
utilized in experiments is shown in Figure 5.9.24. Ifa slip occurs, the wean 
needle will distort the hard rubber diaphragm. The resultant pressure oa. 
be detected by a standard pressure sensor and the generated electrica] den tiie 
to increment the grasping force until the part is stationary within the grip rs 
fingers. = 

_ A possible problem with this scheme is that the action of increasing the 
gripping force to stop slip may, itself, produce a change in pressure, which might 
then be interpreted as additional “slip.” The use of appropriate signal isda 

ing 
techniques would probably reduce or eliminate this situation since the frequency 
content of the slip response signal would, no doubt, differ considerably from that 
produced when the grasping force was increased. Another obvious difficulty with 
the mechanical device shown in Figure 5.9.23 is that it is not possible to obtain the 
density of human hand receptors using such pressure sensors with present tech- 
nology. While prosthetic devices may need a large number of slip-sensing sites 
Over a small surface area, manufacturing applications will generally require con- 
siderably fewer, so that this may not be a serious limitation for an industrial robot. 


Finger Elastic Body 


f 
gineering move T. 
with P 
awn Chicae?” 


Figure 5.9.23. En 
human fingers. (Redraw 
sion of IIT Research Institute, 
IL. From reference [35]-) 





Pressure Sensors 


Sec. 5.9 Touch and Slip Sensors 413 









Silicone Rubber 


Hard Rubber 


Figure 5.9.24. Needle-type pressure 
sensor used for slip detection on the en- 
gineering model shown in Fig. 5.9 20. 
(Redrawn with permission of IIT Re- 
search Institute, Chicago, IL. From 
Finger reference [35].) 


Pressure Sensor 


5.9.3.4 Belgrade hand slip sensors 


As part of a research program aimed at developing a prosthesis that closely 
approximated the function and form of a human hand, a number of slip-sensing 
devices were introduced in the mid-1970s by workers in Belgrade, Yugoslavia. 
Although they differ from one another somewhat in form, all utilize the technique 
of forced oscillation to produce an electrical signal that is used to sense slip. 

The first sensor developed is shown in Figure 5.9.25. As an object slips on 


Hand Surface 





Contact 
a ee : 


VL Figure 5.9.25. The first Belgrade hand 
a is sli sor. A slipping object causes 
— ” the Flic roller to make the reed 


‘brate thereby producing a 
R = (contact) VI a 


fu modulated square wave AT Gaucs 
tesy of Z. Stojiljkovic. From reference 


| _ 
ee (36].) 
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the hand’s “skin,” a knurled roller protruding slightly above the surface revo} 
causing a reed to vibrate against a grounded contact. This action Produces a 
width modulation in the square wave KR, which results in the overall] Signal ." 
Any nonzero output with a duty cycle less than 50% indicates that slip is Occurring 

The major problems with this transducer are that it is both difficult to mir, 
iaturize (important for a prosthetic device) and has a limited reaction angle (; nf 
slippage force must act in the plane of the roller). Also, it can sense slip ip nh 
One direction. 

A second slip sensor for the hand is shown in Figure 5.9.26. Here the knurleg 
roller has been replaced by a needle. An object sliding along the surface of the 
hand causes the needle to vibrate against a grounded contact formed by part of 
the sensor structure. Once again, pulse-width modulation of a “carrier” Square 
wave results. Besides the difficulties of the preceding device, this one will work 
only when small grasping forces are applied. (Large forces will cause the needle 
to “lockup,” thereby preventing mechanical vibration. ) 

The final slip sensor, which overcomes many of the problems associated with 
the other two, is shown in Figure 5.9.27. It can be seen that the roller or needle 
has been replaced by a small conducting spherical ball that can rotate in any direction 
and is partially covered with nonconducting fields (i.e., the dark areas). A slip 
(in any direction) can be detected by monitoring the differential voltage across the 
terminals of the two contacts. Once again, a pulse-width-modulated signal is 
generated when the object slips. 
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a b Figure 5.9.27. Final design of the Bel- 
Contact U grade Hand slip sensor. Slip in any di- 


/ 
Insulation _ = an hye — rection is sensed due to the motion of 
the small sphere. Note that the dark 
Pout areas do not conduct. (Courtesy of Z. 
a, es RA ay a Stojiljkovic. From reference [36].) 


The major advantages of this design over the other two are that slip can be 
sensed in any direction, the device is considerably less sensitive to external vibration 
(i.e., non-slip-related), and it is fairly easy to miniaturize the ball, thereby increasing 
the unit’s ability to detect small tangential motions. In fact, the sensor was actually 
installed on the Belgrade hand and a servo system built. It is possible that such 
a design could be adapted for robotic applications, although this has yet to be 


done. 


5.10 FORCE AND TORQUE SENSORS 


In many manufacturing applications involving industrial robots, it is extremely 
important to be able to adjust and/or monitor the force and torque being applied 
to apart. A number of the tactile sensors described in the preceding section have 
the ability to provide information about how much force the jaws of a robotic 
gripper are exerting on an object. For example, the one produced by the Lord 
Corporation can be used as a force sensor in addition to its limited pattern-rec- 
Ognition capabilities. The reader is referred to Section 5.9 for further information. 

There are, however, applications where only simple force/torque detection is 
required and where the inclusion of object recognition provided by an array of 
sensors may actually slow down the particular manufacturing process. In this 
section, we describe a number of techniques/devices that have been developed for 


monitoring these quantities. 
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9.10.1 Force Sensing by Motor Current Monitoring 


In Section 5.9.3 we described briefly the lift-and-try method of acquiring a Part 
a robotic gripper. This procedure required that the motor current of a Partj by 
manipulator joint (or set of joints) be monitored. An increase in this uantin, 
above some predetermined threshold value indicated that the object had 
grasped successfully. " 
It is also possible to use motor current as a measure of the Srasping force 
If we assume that the gripper itself is servo controlled and that the actuator js . 
servomotor*, the armature current (monitored differentially across a smal] : 


TeSist- 
ance placed in series with one of the motor leads) is proportional to the torque 
generated by the motor. That is, 

1 = T 
0 Ke (5.10.1) 
where J, = current 
IT = total generated torque 
K; = motor’s torque constant 


Through the action of a mechanical rotary-to-linear motion converter (e.g., a rack 
and pinion; see Section 3.4.2.2), this torque is converted into a force (see Figure 
5.10.1). With a pinion gear of radius R, the transmitted force F is 


TX 
R 
where 7 is the efficiency of the rack and pinion assembly (usually on the order of 


90%, i.e., 1 = 0.9). Substituting Eq. (5.10.1) into Eq. (5.10.2) provides the desired 
relationship between the motor current and generated force. Thus 


F= 





(5.10.2) 


F = Met (5.10.3) 


Other rotary-to-linear motion converters (e.g., a lead screw) will yield similar 
results. 

From Eg. (5.10.3) it can be seen that when the robot is commanded to grasp 
a part, the motor current can be increased to a value that produces sufficient —; 
to prevent slipping but is small enough to avoid crushing (or significant mechanica 
deformation that might cause permanent damage). These maximum and minimum 
values of J, would have to be determined a priori (i.e., off-line) for every par '° 
be handled and the information stored in the robot’s controller. This is 2° 4 
major disadvantage, however. It should also be noted that the actual force apple 





— . ;dance 
*For example, such a gripper was developed by a group of students working under the gul 
of one of the authors. 
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Figure 5.10.1. “Electrogrip,” a servo-controlled gripper, developed by U.S. Ro- 
bots and Drexel University, utilizes a rack and pinion and de servomotor to drive 


the fingers of a parallel jaws robotic gripper. Any position within the overall range 
of 2 in. can be obtained with an accuracy of 1 mil. (Courtesy U.S. Robots, Inc. 


and Drexel University.) 


to an object by such a gripper would, of course, be somewhat smaller than that 
indicated by Eq. (5.10.3) because of friction and gravity loads. That is, some 
motor torque (current) would be required to overcome the friction in the various 
mechanical linkages used in a servo-controlled gripper. The controller would have 
to make the appropriate corrections for such “loss terms.” | 

There are some obvious problems with this force-controlling technique. The 
major one has to do with the temperature sensitivity of both the servomotor torque 
constant K; and its armature resistance R,. The reader will recall from the dis- 
cussion in Chapter 4 that Kr decreases as the temperature rises, whereas R, in- 
creases. Therefore, Eq. (5.10.3) reveals that the gripping force will decrease with 
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rising temperature. Thus to control carefully the force applied to an Object With; 
the jaws of a gripper using motor current, it would be necessary to Monitor . 
temperature and have the robot’s controller make the required COITections, : 
could be done using a table-lookup procedure to provide the necessary Correct; 
factor at any given temperature. Additional memory and somewhat increase, 
computational time would be the penalty for such a feature. a 

Difficulties with the technique would also result from brush noise and 
in brush resistance, both of which would make accurate monitoring of the armature 
current a problem. However, as stated in the preceding section, the use of a 
brushless dc servomotor on the gripper would significantly reduce or even COm- 
pletely eliminate this problem. Such a gripper would, of course, be mor 
due to the additional cost of the motor and commutation electronics. 

Understand that the procedure described above is not really a true Sensing 
technique but is, rather, a method for maintaining a desired force. It is motor 
current and not force that is actually monitored, with the current being increased 
until a predetermined value is reached. The servo is used to achieve this. The 
actual force being applied to the object is inferred from the current but never 
measured. In some applications, this may be good enough. However, variations 
in the part weight or some electrical and/or mechanical parameter in the gripper 
itself will not always be sensed. In these cases, the object may either fail to be 
picked up or may be damaged. What is obviously needed is a sensor that provides 
direct information about the actual force being applied to a part. 

One way of meeting this requirement is by making use of an LVDT. The 
reader will recall from Section 5.2.6 that such a device can accurately measure 


linear position. In addition, the force—displacement relationship for a linear spring 
is given by 


Vaflation 


€ Costly, 


F = Kx (5.10.4) 


where K is the spring constant and x is the displacement about an equilibrium 


point. Obviously, the change in the spring length is a measure of the force causing 
the change, that is, 


x= (5.10.5) 


In a force transducer, K is known and constant over some range of operation 
and the LVDT is used to measure the distance. Thus the output of the latter 
device is proportional to the applied force. Schaevitz Manufacturing produces 4 
line of these sensors, which can measure forces from a few grams up to hundreds 
of pounds. (Obviously, different springs must be used as the force range is & 
tended.) | 

In addition to the difficulties with using an LVDT already described in Section 
5.2.6 (i.e., nonzero drift, high cost, need to zero-calibrate, and temperature aa 
sitivity), such a sensor also suffers from additional temperature sensitivity becat 
K varies with this quantity. In addition, its ability to measure force in only 4 siM® 
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direction (usually parallel to the longitudinal axis of the LVDT) limits its usefulness 
in robotic applications, where one cannot guarantee that forces will always be 
orthogonal to the fingers of a gripper. Thus it is not surprising that these trans- 
ducers have not been generally utilized on robots. Clearly, some other type of 


device is required. 
5.10.2 Strain Gage Force Sensors 


One of the simplest methods of sensing a force (or pressure) exerted on an object 
‘s to detect the deflection of the fingers of the robotic gripper in response to such 
an applied force. ‘The strain gage provides a convenient and accurate means of 
doing this. We now describe briefly the operation of such a device. Readers 
interested in learning more are referred to an article by Mounteer and Perrin. [37]. 

The principle underlying the operation of a strain gage is that a mechanical 
deformation produces a change in resistance of the gage, which can then be related 
to the applied force. To better understand the operation of this device, consider 
a simple strain gage consisting of a plastic body (or some other flexible, noncon- 
ducting base) whose top surface is coated with a thin layer of a conducting material 
-(e.g., aluminum or copper. See Figure 5.10.2). If the conductive coating 1S 
assumed to have a uniform cross sectional area A, then the resistance of the device 


is given by 
i 
Ky = (5.10.6) 


where o is the conductivity of the conducting material and L is the length of the 
gage. When glued to an object, any deformation will cause the gage to bend 
either concave up or down (see Figure 5.10.2b and c). Since the conducting 
material thickness is assumed to be small, this bending produces little change in 
A. However, the gage length is either reduced (Figure 5.10.2b) or lengthened 
(Figure 5.10.2c). It 1s seen from Eq. (5.10.6) that such action causes a corre- 


sponding decrease or increase in the gage resistance. 


There are four basic types of strain gages: 


. Unbonded wire 

. Bonded metal foil 
. Thin film 

. Semiconductor 


& Ww WN = 


nonconducting substrate. Here the sensing ele- 
extremely fine platinum tungsten wire. In the 
y foil is glued to either a nonconducting 
dy (nonbonded). With the thin- 
d to deposit resistors onto heat- 


The first does not utilize a 
ment usually consists only of an 
second class, a thin copper OF aluminum allo 
base (bonded) or directly to the object under stu 
film gages, vacuum OF sputter techniques are use 
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Figure 5.10.2. A simple strain gage: (a) undeformed device—gage length L = 
1.5 in.; (b) concave up deflection of an object—L < 1.5 in. and R, decreases; (Cc) 
concave down deflection of an object—L > 1.5 in. and R, increases. 


treated steel substrates. As such, these devices represent the “state of the art” 
in strain sensors. Probably the most sensitive of the four types, however, is the 
semiconductor gage, which is actually divided into two subclasses. One is made 
of silicon elements bonded to a cantilever beam or diaphragm and 1s called 4 
‘bonded bar semiconductor strain gage.” The other borrows photolithographi’ 
and diffusion techniques from integrated-circuit technology to produce a “diffuse 
type semiconductor strain gage.” 

Regardless of what type is employed, some electroni 
to sense the change in gage resistance and produce a voltage out 
Such a circuit is shown in Figure 5.10.3. Here the gage is one arm O 
bridge (R,).- Another arm is adjusted so that its resistance R, 1S 4PP 


c circuit must be us° 

put as 2 res" 
£ a Wheatsto™® 
roximately 


Sec. 5.10 Force and Torque Sensors 421 








Strain Pa 
Ps aN 
— Gage V 
5 — Fa 
—— < 

“XN 
B 6 

[| ¥ 

Vout 


R, =meg 


15 (Balance) 


lil 


Figure 5.10.3. Strain gage bridge circuit. R, is approximately equal to R, when 
the gage is not deformed. R, is used to balance the bridge before any deformation 
occurs. V,, or V,,, can be related to the applied force. 


equal to that of the unstressed gage. A 100 kO fixed resistor R, and a 1 MQ 
balance pot R, complete the circuit. If the bridge is initially balanced, so that 


R,R, —_ R,R, (5.10.7) 


the output voltage V4, will be zero. Any change in R, caused by a deformation 
of the gage will unbalance the bridge and cause V4, to have a nonzero value. By 
applying a known force to the object onto which this sensing device has been 
placed, the system can be calibrated (i.e., the value of V,, can be related directly 
to force). 

An obvious difficulty with this type of force sensor is that variations in ambient 
temperature tend to change the gage resistance, thereby causing the bridge to 
become unbalanced even when no force is applied. It is possible to overcome 
such a problem by either (automatically) rebalancing the bridge periodically or by 
utilizing two gages (and two bridges) and using the difference of their outputs as 
the actual sensing signal. The latter technique requires more circuitry but makes 
temperature drift a second-order effect. 

Strain gages can be used to produce a robotic force sensing element. For 
example, as shown in Figure 5.10.4, these devices can be placed on the back of 
the “‘fingers” of a parallel jaws gripper. Then, as the fingers begin to grasp an 
object, the resultant deflection will be monitored by the gages. If the deflection 
versus force characteristic for the gripper material and structure is known, the 
grasping force can be related to the output voltage. For this technique to be 
successful, the objects being grasped must be made of a solid material that is 
significantly Jess deformable than the sripper’s fingers. Obviously, there will be 
problems with using such a sensor to control the output force while lifting a fragile 
object (e.g., an egg or one made from Styrofoam), and some other force-sensing 
device will be necessary. 
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Figure 5.10.4. A robotic force sensor can be made by placing strain gages on the 
outer surfaces of the fingers of a parallel jaws gripper. These gages monitor the 
finger deflection when an object is grasped. 


Another robotic force sensor making use of strain gages was developed in 
the mid-1970s at Stanford University by V. Scheinman as part of his graduate work 
[38]. A modified version was produced at SRI-NASA Ames for the Ames An- 
thropomorphic robot (see Figure 5.10.5). In reality, this device was a six-dimen- 
sional force and torque detector that made use of clever machining of a piece of 
aluminum tubing to create a series of elastic beams onto which were bonded pairs 
(for temperature compensation) of foil gages. The unit was 3.2-in. long and had 
a 3-in. O.D. and a 0.18-in. wall thickness. 

As can be seen from the figure, there are eight narrow beams, with four 
oriented so that their long axes are in the z-direction (denoted by P,,., Py+, Px- 
and P,_), and with the remaining four perpendicular to the z-direction (denote 
by O,+, Q,+,Q,-, and Q,_). The gage pairs are indicated as R, and Rp and ar 
oriented so that a vector from the center of the latter passes through the center 
the former along the positive x, y, or z direction: for example, the gages 02 on 
P,., and P,_ are perpendicular to the y direction. The neck at one end 0 a 
beam has the effect of “amplifying” the strain at the gage positions while tr 
mitting negligible bending torque. 

If the output voltage from any pair of gages is given the same Nn 
beam, e.g., P, is the voltage due to R, and R, located on beam P;+: 

M,, an 
shown that the three forces F,, F,, and F, and the three torques M,, “y 


ame as the 
it can be 
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Figure 5.10.5. The SRI-NASA Ames force-torque sensor, a modification of the 
work of V. Scheinman, was developed for the Ames Anthropomorphic robot. 
(Courtesy of A.K. Bejczy, Jet Propulsion Laboratory, Pasadena, CA.) 
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Rather than use individual bridges for each gage, the potentiometric atTange- 
ment shown in Figure 5.10.6 was utilized. Although not as sensitive as a Wheat. 
stone bridge, this voltage-divider circuit obviously requires far fewer components 
to produce the desired temperature compensation effect. It should be noted that 
since aluminum is a good thermal conductor, any variation in the ambient tem- 
perature will cause the two gage resistances to change by the same amount. Thus 
the circuit output will not change. 

To prevent failure due to excessive loading, the shear pins were included. 
These permitted the wrist to handle safely maximum x, y, and z forces of 70, 70, 
and 108 Ib, respectively. The maximum safe x, y, and z torque loads were 72, 
72, and 144 in.-lb, respectively. 

A refined version of the foregoing sensor was subsequently built for the Jet 
Propulsion Laboratory under a contract with Scheinman’s company, Vicarm, Inc. 
(later acquired by Unimation) [6]. As shown in Figure 5.10.7, this device replaced 
the elaborately machined cylinder with a “‘Maltese cross” configuration that was 
more easily fabricated out of a single piece of aluminum. Semiconductor strait 
gages, mounted on each of the four sides of the deflection bars of the cross, were 
used in place of the foil types to provide increased sensitivity. Once again, 4 
potentiometric circuit was employed and produced the eight outputs W, to Ws, % 
indicated in Figure 5.10.7. A6 x 8 transformation matrix was then used to conve! 
these data into actual x, y, and z components of force and torque as indicated ™ 
this figure. The information derived from this sensor permitted the adjustme™ 
of the grasping force applied to several test objects. Bejczy reported that | 
results were “highly repeatable.”’ sil 

A commercial robotic force sensor that utilizes strain gages is currently a¥ ee 
able (B and B Machine and Engineering, Allston, Massachusetts). This a 
places the gages on the fingers of a gripper and can yield x, y, z force inform4 oe! 
(Three twising moments can also be obtained from the force data and ards 
opening.) Its sensitivity is 0.5 V/Ib; it has a linear range of +20 Ib with ove! 
of up to +40 Ib permissible, and weighs about 2 oz. 
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Figure 5.10.6. A single degree of freedom on the SRI-NASA Ames force-torque 
sensor of Fig, 5.10.5: (a) mechanical mounting of the strain gages; (b) potentio- 
metric circuit. (Courtesy of A.K. Bejczy, Jet Propulsion Laboratory, Pasadena, 


CA.) 


5.10.3 Compliance and Assembly Operations 

Up to now we have concentrated on sensors that provide information to a robot’s 
controller, thereby permitting an object to be acquired without crushing or slipping. 
The signals from such sensors are used to adjust the gripping force, pressure, or 
torque. Besides picking up parts, there are other operations that may require a 
different type of force adjustment, however. 





426 


Robotic Sensory Devices 





Chap « 
x 
STRAIN GAGE 
™ 
y are 
ILA 
TRANSFORMATION MATRIX 
UNDER IDEAL CONDITIONS 
Wy 
FORCES FY 0 0 kjz3 0 0 O kyz O W 5 
AND F r 
sensanen y 2179 0 O ky95 0 O 0 ake FORCES 
REFERENCED FL 0 32 0 kgq 0 k36 0 kag W4 a 
TO 
x-Y-7 M 0 0 O kg, 0 O O kgg W 5 SPOKE 
ELEMENTS 
COORDINATES 
M, ker 9 keg 0 kes 0 kez O "7 
We 


Figure 5.10.7. JPL ‘‘Maltese cross” version of the sensor shown in Fig. 5.10.5. The matrix 
transformation relating the strain gage outputs to the actual x, y, and z components of the 


forces and torques is also given. (Courtesy of A.K. Bejczy, Jet Propulsion Laboratory. 
Pasadena, CA.) 


As an example, consider a common assembly operation which involves a 
serting a rod (or screw) into a hole (see Figure 5.10.8). Depending on the ame’ 
of clearance that exists between the rod and the side of the hole, any misalign®™ 
caused by either part movement or problems with the robot’s repeatabIny 3), 
cause binding, thus preventing a successful insertion (see Figure 5.10.80 mole 
Successful insertion will generally require that the gripper descend along tne 
center line, as shown in Figure 5.10,8a, ssible '° 

The major problem with such an operation is that it is not always ol ost 
keep the robot positioned properly. Due to the mechanical age "the att 
industrial robots, such a situation will normally result in damage to eit gi » (of 
or the robot, or cause a joint timeout. What is obviously called hae rovots 
compliance) in the manipulator. As discussed in Chapter 1, SCAR 
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Figure 5.10.8. Insertion of a cylindrical rod into a hole: (a) successful insertion occurs if 
the robot's gripper descends along the hole’s center line; (b) binding occurs when the gripper 
descends at an angle to the center line or; (c) parallel to the center line but displaced by a 


distance ‘‘d.” 


have some ability to do this electronically and also because of their jointed cylin- 
drical structure. However, it is possible to provide almost any robot with the 
desired compliance using a passive device called a remote center compliance (RCC) 
placed between the gripper and the wrist flange* (see Figure 5.10.9). The Lord 
Corporation (Erie, Pennsylvania) manufactures a series of these units that combine 
high axial stiffness (i.e., along the direction of the insertion force) and low lateral 
and torsional stiffness (i.e., either perpendicular to or about the direction of in- 
sertion force). By varying the properties of the laminated rubber elastomer com- 
ponents, the compliance of a given RCC can be changed. 

The terms “‘compliant center” or “elastic center” are used to describe a point 
about which rotation occurs when a moment is applied. Lateral translation will 
occur only when a lateral force is applied at the elastic center. The RCC permits 
both of these motions, which facilitate certain types of assembly operations. This 
can best be understood by considering the situation depicted in Figure 5.10.10. A 
position offset between the rod and hole causes a lateral force to be generated at 
the far end of the rod due to the chamfer (see Figure 5.10.10a). With an RCC, 
this force acts through the center of compliance, which causes the shaft to undergo 
a lateral translation, thus permitting it to be inserted more easily into the hole (see 
Figure 5.10.10b). In the case of a nonparallel misalignment such as that shown 
in Figure 5.10.11a, the binding of the rod against the side of the hole will produce 
amoment. This, in turn, will cause a rotation about the compliant center, thereby 


*The RCC is also discussed in Section 3.72: 
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Figure 5.10.9. Family of remote center compliance (RCC) devices that combine 
high stiffness along the direction of the insertion force with low lateral and torsional 
stiffness (either perpendicular to or about the direction of the insertion force). 
(Courtesy of J. Rebman and the Lord Corp., Cary, NC.) 


allowing the shaft to align properly with the hole (see Figure 5.10.11b). Under- 
stand that although the RCC is a passive device and does not actually monitor 
forces due to misalignments, its design is such that, in effect, it utilizes such forces 
to move the gripper, holding a part in a direction so as to reduce the binding force, 
thereby correcting for any misalignment. 

By employing different types of displacement sensors on an RCC, it is possible 
to obtain electrical signals proportional to various torques and forces that result 
from any misalignment between two parts. This information can then be utilized 
in a force or torque feedback scheme. Called an IRCC, the I standing for “in 





Chamfered 
Hole 


Figure 5.10.10. Position offset in 4 
insertion operation can be ae 
an RCC: (a) example of a lateral a 
produced by such an offset; (b) wd sO 
permits the rod to translate eee 
that insertion can be accomplishe 
(Courtesy of J. Rebman and the 

(a) (b) Corp., Cary, NC.) 
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Figure 5.10.11. Nonparallel misalign- 
ment corrected by an RCC: (a) such a 
misalignment of the rod causes binding 
against the side of the hole: (b) the re- 
sultant moment causes a rotation about 
the compliant center of the RCC 
thereby permitting the center lines of 
the rod and hole to become coincident. 
(Courtesy of J. Rebman and the Lord 
(a) (b) Corp., Cary, NC.) 





strumented,’’ such sensors have been developed at the MIT Draper Laboratories. 
The first two prototype units each were able to measure x and y translational and 
rotational position for a coordinate system in which the z-axis pointed along the 
RCC and the tool. That is, they had four degrees of freedom (DOF). One unit 
used four Kaman Scientific proximity sensors (see Section 5.8) as the active element. 
The other one employed a Reticon linear diode array, thin metal shutter, and LED 
light source for each DOF. In the latter case, the number of illuminated photo- 
diodes in the array gave the shutter position. Both sensors were developed pri- 
marily for laboratory (research) purposes and were not well suited for the manu- 
facturing environment, due to difficulty in calibration and high cost. 

A more practical device was also developed that had only three DOFs (x, y, 
and 6@z, i.e., z-axis rotation). The three positional sensors each consisted of an 
LED and dual-photodiode combination and were mounted on a Lord Corporation 
RCC. With the photodiodes connected differentially, any displacement of the 
RCC produced a signal that was proportional to the offset from the null or unforced 
position. In actual experiments this device was used on the wrist of a PUMA 600 
robot and interfaced to the robot’s controller through the I/O module utilizing the 
VAL robot programming language [39]. 

A number of applications were attempted, including chamferless insertion, 
edge following, and seam tracking. The first used the IRCC as a touch sensor to 
detect when a peg, tilted 10° from the hole axis, contacted the hole side (see Figure 
5-10.12). The passive compliance of the RCC was then used to complete the 
insertion, In the case of edge following, the transducer provided force information 
Which was used to adjust the y position so that a force of from 1 to 2 lb was exerted 
against the edge of the plywood material by a rotary cutting tool. The z-axis was 
Perpendicular to the material surface and tool motion was along the seam in the 
tool x direction (see Figure 5.10.13). Inadequate sampling of the sensor Signals, 
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Figure 5.10.12. Chamferless insertion of a peg in a hole using an IRCC. (Cour- 
tesy of D. S. Seltzer, the Charles Stark Draper Laboratory, Inc Cambridge MA.) 
5) oan) 5“ . 


eeds 


due in large part to using the PUMA’s I/O lines, resulted in limited tracking SP**"’. 
e of 


(e.g., about 12 in./min). The passive RCC has only a relatively small rang 
operation (e.g., +0.1in.), so that its ability to edge track 1s severely limited. 
instrumented device, however, extends this range significantly 

With seam tracking, the IRCC was required to provided two-dimension® 
force information because of the need to maintain constant contact with two surface” 
instead of one. (This would be a required task during an arc welding applicatlo ) 
Once again, the low sampling rate limited the tracking s eed (i.e., f0 about 11 in! 
min). The sensor was also uSed in an experiment sr self-learning. Reade 
wishing to learn more about this are directed to no ae ae [39]. 
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Figure 5.10.13. Edge following using an IRCC. Force information from the 
sensor is used to adjust the y position of the rotary cutting tool so that a constant 
force of 1 to 2 Ib. is maintained against the plywood. (Courtesy of D.S. Seltzer, 
the Charles Stark Draper Laboratory, Cambridge, MA. From reference [39].) 


Besides the MIT devices, a series of commercial six-axis IRCCs has been 
developed by the Barry Wright Corporation (Watertown, Massachusetts) (see Fig- 
ure 5.10.14). Utilizing six foil-type, strain gages mounted on a standard RCC 
(produced by Astek Engineering, Inc., Watertown, Massachusetts), the Model 
FS6-120A provides electrical signals (obtained from six separate bridges) that are 
proportional to three forces (ranging from maximums of 25 to 150 lb) and three 
moments (ranging from maximums of 18 to 108 in.-Ib). These sensors weigh about 
1 lb and include in their on-board electronics package a microprocessor (TI 9995) 
to convert the information into a user-specified orthogonal coordinate frame. To 
accomplish this, the output from each of the strain gage bridges is buffered, low- 
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Figure 5-10.14. A commercial instrumented remote center compliance: (a) artist's 
conception of an IRCC attached to a robot: (b) actual IRCC mounted on a robot 


shown grasping a motor armature. (Courtesy of P. Cholakj ht COrp-. 
Watertown, MA.) y . Cholakis, Barry Wrig 
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Figure 5.10.15. Successful insertion of a gear-shaft assembly into a bearing has 
been achieved by using a three-axis strain gage sensor mounted on the gripper’s 
fingers to provide electronic compliance. (Courtesy of T.A. Brownell, General 


Electric Company, Corporate Research and Development, Schenectady, NY. From 
reference [40].) 


pass filtered, and then input to a 6:1 multiplexer. A 12-bit DAC digitizes the data 
so that it can be handled by the microprocessor. Both analog and digital outputs 
are available for interfacing with the robot’s controller. 

Another technique for obtaining compliance has been demonstrated by Brow- 
nell at General Electric Research and Development [40]. In his experiments, a 
three-axis strain gage sensor developed at B & B Machine and Engineering (Allston, 
Massachusetts) was placed on each of the fingers ofa parallel-jaws gripper and 
provided tool x, y, and z force components. T hese Sensors were particularly well 
suited to robotic applications because of their light weight (2 oz), small size (1.5 
in. X 2.5 in. x 0.84 in), and large force range (+20 lb with a +40 lb overload 
capability). The information obtained by the B & B devices was then converted 
to joint coordinates by applying the appropriate matrix transformations for the 
Cartesian robot used. The resultant joint force feedback provided a means of 
varying the applied force (i.e., adjusting the compliance electronically). | 

Brownell found that with this scheme, it was possble to acquire fixed objects 
even when the robot’s gripper was deliberately placed off-center. The same ex- 
periment failed when zero-force feedback was used. In addition, electronic com- 
pliance permitted successful insertion of a gear-shaft assembly into a set of bearings. 
In this application it was also necessary to mesh the gear teeth with those of a 
larger gear located nearby (see Figure 5.10,15). 
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2.11 SUMMARY 


extensively the topic of non-vision-based robotic 


sensors. These have been divided into two classes, those that provide interng) 
information and those that provide external information. _The former group of 
devices is generally used to keep track of the individual joint’s instantaneoys 0. 
sition, velocity, and/or acceleration. With the data from these sensors, the joints 
can then be controlled properly. Of all the sensors considered, the optical incre. 
mental encoder has been presented in great detail and many of the practical cop. 
siderations necessary for its successful application to robots discussed. 

The second group of sensors introduced 1n the chapter provides the robot 
with the information about its (external) environment. As discussed, most of these 
devices are still quite experimental in nature, with only a few commercial units 
available. In the future, it will be absolutely essential that robots performing 
complex manufacturing tasks possess the ability to apply just the right amount of 
force/pressure to an object. In addition, it will be important that these manipv- 
lators be able to determine what the object is from a tactile “image”’ provided by 
an array of sensors located in the gripper. One group of external sensors that are 
well developed are those used on welding robots. These units are currently often 
utilized to assist the manipulators in producing welds that are both accurately placed 
and of high quality. 


In this chapter we have treated 


5.12 PROBLEMS 


5.1 For the position loop shown in Figure 5.2.5, the home position of a robot joint is 
assumed to be at zero degrees and occurs when both the input and sensing pots are 
outputting zero volts. Find the appropriate pot settings to produce demand positions 
DP,, DP2, and DP; of 30, 45, and 300°, respectively. Assume that the input and 
sensing pots are identical and that + V corresponds to + 180°. 


5.2 If the digital codes of 00, 01, 10, and 11 are used to select Home, DP,, DP,, and DP; 
respectively, determine the sequence of 2-bit numbers necessary to produce the fol- 
lowing joint moves: 

a. 0 to 30 to 300 to 45. 
b. 0 to 45 to 30 to 300 to 0. 


Discuss timing considerations in these moves. 


5.3 The demand position pots in Figure 5.2.5 can be replaced by op amps which have 
feedback resistances that can be changed. Design a circuit that makes use of 2 S¢! of 
digital switches to permit the selection of a numb ‘stances used 0 
the feedback path of an op amp. ie a 


5.4 For an LVDT, it is necessary to convert th i sing 
mae e ac volta series OPP° 
secondary coils into a dc voltage. Be aenpen tne pwe 


a. Show that a full-wave bridge will 


. - ontiOn 
Provide on] on (i.e., direc#© 
cannot be obtained in this way) y magnitude information (i 
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b. Design a circuit that can be used 
to give both th i i 

that is proportional to the linear eeacs. e magnitude and sign of a voltage 

5.5 In Figure 5.3.3, design the one-shot and debounce circuit 
5.6 In Figure 5.3.3, why isi ; ) 
Explai i y is it necessary to use a one-shot instead of a 555 timer, for example? 
5.7 In Figure 5.3.3, why must the output of th ‘ “ ” 
happens if it isn’t? p e one-shot be “‘short enough,” and what 
5.8 For BORG eres design a circuit that permits the motor to turn in both directions. 
5.9 Design a circuit for Figure 5.3.2 that allows the motor to be dynamically braked (as 
opposed to coasting to a stop). 

5.10 Describe what might happen if the black flag located on the disk in Figure 5.3.2 was 
too small and the motor was permitted to coast to a stop. 

5.11 Suppose that the motor in Figure 5.3.2 is driving a gear train (ratio n:1) and that the 
optical interrupter is on the output side of the gear train. Design the system so that a 
robot axis connected to the gear train will rotate to points located at 30°, 125°, 245", 
and 325°. 

5.12 Draw a comparator circuit (whose input 
and show that the TTL pulses in Figure 
changes (i.e., aS Eve in Figure 5.3.10 changes). 

5.13 Discuss the reasons for a high-frequency limitation on an optical encoder. Consider 
the effect of narrow pulses due to drift in the average value of the output photosensor 
waveform. 

5.14 Using a D-type flip-flop with clock input, show that it is possible to determine rotational 
direction represented by the two sets of waveforms shown in Figure 5.3.8. 

5.15 Show that a two-input Exclusive OR (XOR) gate will double the effective resolution 
of an N-line encoder. Consider both CW and CCW rotations. 

5.16 Complete all of the entries for the ROM of Table 5.3.1 so that all possible A- and B- 
channel transitions produce the appropriate up Or down count for CW or CCW motion, 


respectively. oo _ 
5.17 Discuss possible timing problems that might be encountered in utilizing the circuit of 
Figure 5.3.16. What might be a solution to such problems? 
5.18 Consider CCW motion of an encoder disk. For the circuit of Figure 5.3.17, obtain a 
timing diagram similar to Figure 5.3.18. 
5.19 For the situation in Problem 5.18 suppose that t 
that the count does increase for each edge encoun 
the encoder. Write out the binary count for at least two 
lid data exist on 
5.20 Consider the problem of ensuring that va | 
bit position counter of Figure 5.3.17. Discuss the importance 0 


axis and devise a scheme for handling this problem. | | 
5.21 For the x4 circuit of Figure 5.3.17, discuss any limitations on the dual one-shot period. 


Are there upper and lower limits? | 
5.22 Show that it is possible to obtain eight ed 
tracting the A- and B-channel signals. 


is the triangular wave shown in Figure 5.3.10) 
5.3.11 will vary in width as the light intensity 


he counter is initialized at zero. Verify 
tered on the A and B channels of 
encoder lines. 

the output lines of the 16- 
f valid data for a robot 


ges per encoder count by adding and sub- 
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5.24 


5.25 


5.26 


$.27 


5.28 
5.29 
5.30 


Pe | 


5.32 
5.33 
5.34 


5.35 
5.36 


S37 
5.38 
5.39 
5.40 


5.41 


5.42 
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Design a x8 digital circuit that utilizes the four TTL signals obtaineg 

A — B,andA + B. TOM A, p 
For the situation in Problem 5.23, discuss the importance of maintaining ¢| | 
on A- and B-channel quadrature (i.e., consider what happens to A — a. toler, 
if B is not exactly 90° out of phase with A). and A 
Discuss the reasons why variation of temperature and line-voltage fluctyat; 
cause the calibration point to change when no encoder index pulse is useq Uations Can 
the index pulse practically eliminate calibration sensitivity to such fluctuatic dogs 

ns’ 


With respect to Figure 5.5.1, use a plausibility argument to show that points D 
Or F 


+B 


are unstable. 
Show that if a robot joint is in the “home” position and its servo is operating in g 
nha Og 


lock mode, any disturbance that causes the encoder to rotate beyond point p 
(Figure 5.5.1) will produce a position error of exactly one encoder line. Discyugg . / 
one might prevent this from happening. i 
Draw a block diagram of a servo that uses both all-digital-position information durin 
motion and an analog locking scheme in the “‘home”’ position. ; 
Derive the first-order velocity algorithm stated in Section 5.6.2.2. 

If an encoder is read every T seconds so that the position is P(KT), derive a second- 
order approximation for the velocity. Show that it will take longer to execute and 
that there will be more phase lag (i.e., time delay) introduced into the system. 
Draw a computer flowchart that implements the scheme described in Section 5.8.2.1 
(for a reflected light sensor) to eliminate the ambiguity in position due to the double- 
valued position versus voltage curve of the photosensor. 

Discuss why recessing the sensor inside the gripper’s fingers eliminates the position- 


ambiguity problem. 
For the proximity rod tactile sensor described in Section 5.9.1.1, discuss the need for 


a switch closure threshold. 
How would one convert the output of the Lord sensor described in Section 5.9.1.2 to 


monitor pressure or force? 

For the Lord sensor, discuss the difficulties caused by rubber hysteresis. 
Complete Figure 5.9.5, showing the correct inputs for the 74155 and 74156 decoders. 
Obtain a truth table for the appropriate inputs for row and column decoding. 


Extend the circuit in Problem 5.36 to a4 X 4 array. 
Show the effect of crosstalk if the diodes are not used in Figure 5 9.5. 
Discuss the problem of hysteresis with the Hillis sensor shown in Figure 5.9.6. 
Draw a block diagram for a robot controller that incorporates the sensory 11 
obtained form an arc welding seam tracker. What must be done to these data 
the individual joints can be commanded properly? 
Derive the relationship between force and motor current 
The servomotor is driving a gear train with a reduction ratio 
in turn, drives a lead screw that has a pitch P. Assume that t 
m, and that the gear train’s efficiency is 7. on to Ue 
Draw a flow chart for a robot’s program that will permit shape informant é red 
obtained if a single contact rod proximity sensor (like the one in Figure 5.8. 1) 18 


“pel: 
fora servo-controlled on iD 
of nil. The geal ©". 


is 
fficienY 
he screw S © 
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5.43 Show that for the voltage divider circuit sh 


on a robot’s gripper. 


Discuss any execution and/or time problems associated with 
such a process. 


own in Figure 5.10.6, if R, and R, both 


change by either +AR or — AR, the output voltage with respect to ground is unchanged. 


5.13 REFERENCES AND FURTHER READINGS 


ie 


10. 


aL. 


12, 


43: 
14, 


15. 


Cushing, I. B., “A New High Accuracy Angular Position Transducer,” PCI/Motor-Con 
Proceedings, Atlantic City, N.J. April 1984. 


. Welburn, R., “Ultra High Torque Motor System for Direct Drive Robotics,”’ Proceed- 


ings of the Robots 8 Conference— Applications for Today, Vol. 2, Detroit, Mich., June 


4—7, 1984. Dearborn, Mich.: Society of Manufacturing Engineers, 1984, pp. 19-63 to 
19-71. 


. Luh, J. Y. S., Fisher, W. D., and Paul, R. P. C., “Joint Torque Control by a Direct 


Feedback for Industrial Robots,” JEEE Transactions on Automatic Control , Vol. AC28, 
No. 2 (February 1983), pp. 153-161. 


. Szabo, Ernest, “Feedback of the Actual Position Utilizing the Existing Controller of a 


Robotic Arm,” M.S. thesis, Drexel University, June 1984. 


. Hall, David J., ““Robotic Sensing Devices,’’ The Robotics Institute of Carnegie-Mellon, 


Report No. CMU-RI-TR-84-3, March 1984. 


. Bejczy, Antal K., “Smart Sensors for Smart Hands,” Proceedings of AAIA/INASA 


Conference on “Smart Hands,’’ November 19738. 


. Fayfield, R. W., “Controlling with Bendable Bundles of Light,” Production Engineer- 


ing, Vol. 28, No. 7 (April 1981). 


. Ueda, M., et al., “One Trial to Use a Simple Visual Sensing System for an Industrial 


Robot,” Proceedings of the 6th International Symposium on Industrial Robots, University 
of Nottingham, England, March 24-26, 1976. 


. Larcombe, M. H. E., “Tactile Sensors, Sonar Sensors, and Parallax Sensors for Robot 


Applications,” Proceedings of the 6th International Symposium on Industrial Robots, 
University of Nottingham, England, March 24—26, 1976. 


Kilmer, R. D., “Safety Sensor Systems,” in Robot Safety, ed. M. C. Bonney and Y. 
F. Yong. Berlin: Springer-Verlag, UK: IFS (Publications) Ltd., 1985, pp. 223-235. 
Einbinder, S., Kirshtein, J., et al., “Electronic Droid with Intelligence (EDWIN): An 
Autonomous Mobile Robot Prototype,” Final Report, Senior Design Project ECE 3, 
Drexel University, Philadelphia, May 1983. 

Bauzil, G., Briot, M., and Ribes, R., “A Navigation Sub-system Using Ultrasonic 
Sensors for the Mobile Robot HILARE,” Proceedings of the First Annual Conference 
on Robot Vision and Sensory Control, Stratford-Upon-Avon, England, April 1981. 
‘“Transducers,’’ Machine Design, Vol. 54, No. 11 (May 13, 1982), Section 5. 

Cook, G. E., Wells, A. M., Jr., and Eassa, H. “Microcomputer Control of an Adaptive 
Positioning System for Robot Arc Welding,” JECI Proceedings of Applications of Mini 
and Microcomputers, November 1981. 

Starke, L., “Limit Sensors and Proximity Switches and Control Techniques,” Elektro- 


438 Robotic Sensory Devices 


16. 


17. 


18. 


26. 


vee 


a9; 


3). 


Si. 


Chap, 5 
meister and Deutschers Elektrohandwerk, Vol. 55, No. 18. September 1980 [unt 
lated]. rans. 
Cupp, J. C., “Capacitive Probe and Constant O Circuit for Measuring He 
Height,” 7BM Technical Disclosure Bulletin, Vol. 22, No. 1 (June 1 979). 
Belforte, G., D’ Alfio, N., Quaglorotti, F., and Romti, A., “Identification t 
Jet Sensing.” Proceedings of the Ist International Conference on Robot 
Sensory Controls,” Stratford-Upon-Avon, England, April 1981. 


“Hall-effect Transducer Improves Sensing Capability,” Automotive Engineering. Vol 
89, No. § (August 1981). ) 


ad Flying 


hrough Air 
Vision ang 


- Hillis, W. Daniel, “A High Resolution Imaging Touch Sensor,”’ International Journal 


of Robotics Research, Vol. 1, No. 2 (Summer 1982), pp. 33-44. 


- Harmon, L. D., “Automated Tactile Sensing,” International Journal of Robotics Re. 


search, Vol. 1, No. 2 (Summer 1982), pp. 1-32. 


. Page, C.J., Pugh, A., and Heginbotham, W. B., “New Techniques for Tactile Imaging,” 


The Radio and Electronic Engineer, Vol. 46, No. 11 (November 1976), pp. 519-526. 


- Nobuaki, S., Heginbotham, W. B., and Pugh, A., ““A Method for 3-D Part Identification 


by a Tactile Transducer,” Proceedings of the 7th International Symposium on Industrial 
Robots, Tokyo, October 1977. 


- Hill, J. W., and Sword, A. J., “Manipulation Based on Sensor-Directed Control: An 


Integrated End Effector and Touch Sensing System,” Proceedings of the 17th Annual 
Human Factors Society Convention, Washington, D.C., October 1973. 


. Rebman, J., and Trull, N. W., ““A Robust Tactile Sensor for Robot Applications,” 


Lord Corporation Technical Article, 9/83-250, 1983. 


. Snyder, W. E., and St. Clair, J ., “Conductive Elastomers as Sensor for Industrial Parts 


Handling Equipment,” JEEE Transactions on Instrumentation and Measurement, Vol. 
IM27, No. 1 (March 1978), pp. 94-99. 


Garrison, R. L., and Wang, S., ‘A Pneumatic Touch Sensor,” JBM Technical Disclosure 
Bulletin, Vol. 16, No. 6 (November 1973). 


De Rossi, D., and Dario, P., “Multiple Sensing Polymeric Transducers for Object 
Recognition through Active Touch Exploration,” Proceedings of Workshop on Robotics 
Research: The Next Five Years and Beyond, Paper MS84-492, Lehigh University, Beth- 
lehem, Pa., August 1984. 


. Dario, P., Domenici, C., Bardelli, R., De Rossi, D., and Pinotti, P. C., ‘“‘Piezoelectric 


Polymers: New Sensor Materials for Robotic Applications,” Proceedings of the 13th 
{International Symposium on Industrial Robots and Robots 7, Vol. 2, Chicago, April 
1983, pp. 14-34 to 14-49, 


Klafter, R. D., and Park, K., ‘A High Resolution Tactile Sensor,” Progress report of 
work done at Drexel University, Temple University, and United States Robots for the 
Ben Franklin Partnership, Advanced Technology Center of Southeastern Pennsylvania, 
September 1984, 


Grahn, A. R., and Astle, L., ‘Robotic Ultrasonic Force Sensor Arrays,”’ Proceedings 
of the Robots 8 Conference—Applications for Today, Vol. 2, Detroit, Mich., June 4- 


7, 1984. Dearborn, Mich.: Society of Manufacturing Engineers, 1984, pp. 21-1 ' 
21-17. 


Raibert, Marc H., and Tanner, J. E., “Design and Implementation of a VLSI Tactile 


Chap.5 References 


32. 
33. 


34. 


35. 


36. 


3/. 


38. 


39. 


40. 


439 


Sensing Computer,” International Journal of Robot Fall 
1982), MIT Press, pp. 3-17. of Robotics Research, Vol. 1, No. 3 (Fa 


Electronic Design, February 7, 1985, pp. 69-70. 


Presern, S., Spegel, M., and Ozimek, I., ‘Tactile Sensing System with Sensory Feed- 
Back Control for Industrial Arc Welding Robots,” Proceedings of the 1st International 


Conference on Robot Vision and Sensory Controls, Stratford-Upon-Avon, England, 
April 1981, pp. 206-213. 


Presern, S., Ducar, F., and Spegel, M., ‘Design of Three Active Degrees of Freedom 
Tactile Sensors for Industrial Arc Welding Robots,” Proceedings of the 4th British Robot 
Association Annual Conference, Brighton, England, May 1981. 


Ueda, M., and Iwata, K., “Tactile Sensors for an Industrial Robot to Detect a Slip,” 


Proceedings of the 2nd International Symposium on Industrial Robots, ITT Research 
Institute, Chicago, May 1972, pp. 63-76. 


Tomovic, R., and Stojiljkovic, Z. ‘Multifunctional Terminal Device with Adaptive 


Grasping Force,” in Automatica, Vol. 1, No. 6, Elmsford, N.Y.: Pergamon Press, 1975, 
pp. 567-570. 


Mounteer, C., and Perrin T., Jr., ‘‘Pellicloid Pressure Sensor,” Sensors, Vol. 1, No. 10 
(October 1984), pp. 23-27. 


Scheinman, V. D., “Design of a Computer Manipulator,” Artificial Intelligence Lab- 
oratory Memo AIM-92, Stanford University, Palo Alto, Calif., 1969. 


Seltzer, D. S., ‘Tactile Sensory Feedback for Difficult Robot Tasks,” Proceedings of 
the Robots 6 Conference, Detroit, Mich., March 2—4, 1982. Dearborn, Mich.: Society 
of Manufacturing Engineers, 1982, pp. 467—478. 


Brownell, T. A., and Ringwall, C. G., “Tactile Sensing for Manipulation,” General 
Electric Company Report No. 84CRD003, February 1984. 





6 


Computer Vision for Robotic 
Systems: A Functional Approach 


6.0 OBJECTIVES 


The didactic material covered in this chapter is intended to expose the reader to 
many considerations required in providing computer vision for robotic Systems: 


e Computer vision components 

e Computer vision task complexity 

e General approaches to computer vision architecture 

e Problem types amenable to solution by computer vision techniques 


To reach these objectives, not all topics in computer vision can be treated, 
since complete coverage of this subject would easily require several volumes. Be- 
fore the specific issues of computer vision systems are addressed, the functional 
requirements of machine vision should be presented. Let us consider certain visual 
tasks, requiring only an intelligent observer. Basically, these visual tasks con- 
cerning handling or acquisition of a part can be thought of as a series of questions 
that an expert viewer (or a robot) must answer: 


e Where is it? 

e Is it the one I am looking for? 
e Is it defective or is it OK? 

e How far away is it? 

e Is it right side up? 
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e Is it being interfered w; 
type? ‘ with by another object of the same type? or a different 
e What is the angle of the ob; 
ject relative to 9 
e What color is it? "a 


These types of questions lead 
; us to consider th intelli 
system and its components: e human visual intelligence 


e Eye(s) 
e Neural connections (sensory and motor) 
e Visual cortex 


Physiologic subsystems can (very) loosely model the architecture of current 
(machine) vision systems. These include: 


e Sensors 
e Data paths 
e Computer or processor 


These major subsystems have numerous subtopics, but it is clear that the functional 
issues suggested by the questions above are addressed generally by the sensory 
—— data path —> computer configuration. This configuration is far too general 
and must be further subdivided. With this in mind, the topics that will be covered 
in this chapter are: 


e Imaging components 

e Image representation 

e Hardware considerations 

e Picture coding 

e Object recognition and categorization 

e Software considerations 

e Need for vision training and adaptations 
e Review of existing systems 


6.1 MOTIVATION 


“Computer vision” is a somewhat glamorous phrase that describes a wide class of 
computer image analysis topics. The use of the word “vision” is in many ways a 
poor choice, because it imbues a “‘sense”’ or “‘intelligence”’ to the robot that is 
undeserved and nonexistent. As used in this text and in most applied fields, 
“computer vision” is simply the analysis of photometric noncontact measurements 
obtained from a closed-circuit television (CCTV) camera or other photo-sensing 
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6 
element, such as a linear photoarray. Although there are a wide Variety of 
toimaging sensors, we will generally use the term CCTV in reference to the stam 
television camera, and not to the generic class of photosensors. We wij - 
refer to the sensor as being a CCTV, but the reader should extend the fies 
to other types of photosensors. The electrical voltage output from the ccty 2 
generally converted to a digital form, where processing of the image informatio, 
by a digital computer may be accomplished. . 
The type of information to be produced by such a camera—computer couplet 
is: 
Location of a stationary object 
Object tracking as a function of time 
Object identification 


Object orientation | 
Defect recognition and inspection of an object 


These types of tasks may appear somewhat mundane rather than exotic, but 
they are far from trivial as far as computer implementation is concerned. Consider 
that most CCTV images are usually broken down into rectangular matrices of 
roughly 320 x 240 elements, with each element corresponding to an intensity from 
the scene being imaged. Consider the problems of searching through 76,800 (320 
x 240) elements of an array at television rates (50 or 60 cycles/second), generally 
about 4.5 million searches per second. Scanning intelligently through this amount 
of data at these rates is no mean feat, and in fact it is the root of most of the 
problems facing today’s computer vision systems. | | | 

Why, then, bother with “computer vision”’ systems if they require such high- 
speed, high-data volume solutions? The answer is simple: noncontact measure- 
ment! The advantages of noncontact location, detection, and identification are 
often so overwhelming that one is often forced to “computer vision”’ solutions. It 
is often the case that vision is the only sense capable of doing the job required, 
and human vision is often selected. In those cases where human interactive vision 
has proven necessary, it is reasonable to try to utilize computer vision toward the 
same end. | | 7 | he 

In situations where there is no alternative to vision, the function must 
performed by either a human being or a machine. For example, in the — 
of bar codes or OCR codes (optical character reader codes), vision processing ce 
be performed, and the time penalty becomes irrelevant. One measure of the € a 5 
of the additional time penalty is the UPH or “units per hour”’ factor. apr 
sequential processes, such as ‘‘assembly”’ and “‘visions,’’ one can define this 
as follows: 

1 
1 1 


assembly UPH r vision UPH 





UPH = 
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,2 IMAGING COMPONENTS 


The imaging component, the “eye” or the sensor, is the first link in the vision 
chain. Numerous sensors may be used to observe the world. All the vision com- 
ponents have the property that they are ‘‘remote sensing” or ‘““noncontact”’ meas- 
urement devices. 

Vision sensors can be categorized in many different ways. For convenience, 
we will categorize them according to their dimensionality although they could also 
be classified by their wavelength sensitivity (i.e., do they respond to shades of 
black and white, or colors, or infrared, x-ray, ultraviolet, or the normal spectrum 
of human vision?). Vision sensors may be conveniently divided into the following 
dimensional categories or classes: 


e Point sensors 

e Line sensors 

e Planar sensors 
e Volume sensors 


6.2.1 Point Sensors 


The point sensors may be similar to “electric eyes,’ being either some type of 
photomultiplier, or more commonly, a phototransistor (see section 5.8.2.1). In 
either case, the sensor is capable of measuring the light only at a single point in 
space. For this reason they are referred to as “‘point sensors.’? These sensors 
may be coupled with a light source (e.g., a light-emitting diode) and used as a 
noncontact “‘feeler,’’ as shown in Figure 6.2.1. 

The “‘feeler”’ essentially monitors the light in a small ‘“‘acceptance aperture.” 
If an object falls in this acceptance aperture, light will be reflected from the object’s 
surface and will be received by the sensor. If the acceptance aperture is clear, no 
light will be reflected into the sensor and it will not ‘‘feel’’ anything. 

The point sensor may be used to create a higher-dimensional set of vision 
information by scanning across a field of view by employing some ancillary mech- 
anism. For example, an orthogonal set of scanning mirrors (see Figure 6.2.2) or 
an x-y table can be employed to execute the scanning of the scene. 










Point 
i _ Out of Sensing Figure 6.2.1. Noncontact feeler-point 
| Limit (i.e., proximity) sensor. The object is 


Soe ome . 
Pe sensed only if its location falls between 
a d, = near sensing limit d, and d,. Points located beyond d, are 
0 d, dy d, = far sensing limit out of the sensing limit of the device. 


uminator 
and 
Point Sensor 


Reflected Ray (from object's surface) 





| 
Incident Ray (to object's surface) f Pivot 
| 
! Je 
| 
——______ c &) 
Object Horizontal 
Scanning 
Z Mirror 
/  Nertical ? 
Ssanhing Figure 6.2.2. Image scanning using a 
Mirror point sensor and oscillating deflecting 


mirrors. 


6.2.2 Line Sensors 


Line sensors are one-dimensional devices and may be used to collect vision infor- 
mation from a scene in the real world. The sensor most frequently used is a “line 
array’’ of photodiodes or charge-coupled-device components. ‘These devices are 
similar in operation, both being the equivalent of “analog shift registers” that 
produce a sequential, synchronized output of electrical signals corresponding to 
the light intensity falling on an integrating light-collecting cell. See Figure 6.2.3 
for a schematic representation. The light output from these arrays is available 
“sequentially” (i.e., the individual cell outputs are not available in parallel or even 
on demand). The consequence of this is that the light intensity from the scene is 
available only in an ordered sequence and not at random on demand by the user. 
This has some consequences with regard to the time required for accessing a desired 
point intensity. The arrays may also be obtained in other than straight lines (e.g., 
circular arrays or crossed arrays are available; see Figure 6.2.4). 

By proper scanning, line arrays may be used to image a scene. For example, 
by fixing the position of a straight-line sensor and moving an object orthogonally 
to the orientation of the array, one may scan the entire object of interest. Figure 
6.2.5 is an example of such an application in a robot system. 


Light Integrating Cells 


CDI DODD | 


CCD Analog Shift Register Analog Output 


. ; : ional 
Figure 6.2.3. Schematic representation of line scanning arrays. The analog output i 
is a sequential representation of the intensity of the light collected by the integrating © 
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Figure 6.2.4. Circular and crossed configurations of light sensors. 


6.2.3 Planar Sensors 


Planar sensors are an extension of the line-scan concept to a two-dimensional 
configuration. ‘Two generic types of these sensors are generally in use today: 
scanning photomultipliers and solid-state sensors. 

The scanning photomultipliers are represented by television cameras. The 
most common type of television camera used is the vidicon tube which is essentially 
an optical-to-electrical converter. The photoelectric target ‘‘boils off’ electrons 


Video Processing 
System 


Line Scan Camera 


TV Monitor 
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Conveyor Belt _—s_— 
Travel 


Figure 6.2.5. An automated robot sorting system using a line scan camera to 


generate two-dimensional images. 
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When struck by photons in the visible spectrum. The electrons boiled off ; 
Process are collected via the current in a scanning electron beam. This he this 
scanned back and forth across the photoelectric target in a so-c “am j 


alled ras; he 
(see Figure 6.2.6). The rate and pattern of the raster scan dif v7 lashion 


fers thr 
world with a variety of existing standards. ewehout 
A more detailed description of the operation of this tub 
image is focused on a photocon 
plate. When light strikes this | 


to the positive Signal plate. 
of the target. 


| e€ follows. N opti 
ductive target layer which lies behind a transpar = 
n 


ayer, it becomes conductive and transfers Electron, 
S 


The transfer causes a charge to build UP ON the fac 
Its reverse face is scanned by a low velocity : 


electron beam that 
tends to stabilize the target at the cathode’s potential. This Scanning causes j 
Current to be generated which is indicative of the light intensity pattern On the 
Photoconductive layer. 


It is important to note t 
transferring charge to the pla 
In fact, the amount of charg 
integral of the light intensity. 


hat each time the target is scanned, it again begins 
te depending on the intensity of the incident light. 
€ may be thought of as bein 


Since the raster scan is periodic in time 
amount of light is incident on a particular point, the same char 


at each pass of the scan. From this description, it can be inf 
possible to expose a vidicon to light and randomly read the data 
results by executing a single raster scan. 

As in any physical system, the vidicon family has an upper limit to the amount 
of intensity that can be accepted by the photoconductive layer. If too much light 
is incident on a certain portion of the sensor, additional electrons (i.e., those above 
and beyond what would be removed by the normal incident light) from nearby 
areas may also be removed. This phenomenon is called blooming and is evidenced 
as an area of maximum intensity in the image. 

Another important concept of the vidicon is that when the electron beam 
resets the charge, it may not reset it completely. Any remaining charge then 
decays exponentionally. The term given to this phenomenon is called lag and 1s 
related to the speed of response of the camera. The physical manifestation of ag 
is that when viewing a moving object it may seem transparent. Additionally, ‘ 
one observes an object as it moves into a camera’s field of view and then — 
may be necessary to wait for the motion to cease (i.e., 60 to 200 ms) before 
accurate representation of the object can be obtained. | —_— 

The RS-170 standard (described more completely below) used in Nort ecan 
ica specifies a 525-line 60-Hz physical format. Like line-scan iene os ai 
devices provide serial or sequential access to the converted optical ‘ oat 
information about a given point in the field of view may be periodica > cupaet 
at a certain rate, but may not be accessed at random. In the case O ey ance 
television camera, each intensity point from the camera may be ry penalty 
every 33.3 ms (i.e., at 30-Hz = 1/33.3 ms). In many applications 7. nications. 
is not severe, but in others it is almost intolerable. In most robotic ap 


, If a constant 
ge will be present 
erred that it is not 
OF expect consistent 
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cycle times of 1 to 10 s are commonplace, and the additional time needed for robot 
vision processing would probably be acceptable. Most currently available vision 
systems provide about five vision cycles per second, so the extra 200 ms is not 
significant. However, in a small-parts assembly where the manipulator portion of 
the assembly cycle may be on the order of 1 s, the additional 200 ms for vision 
processing begins to have a significant effect. In an application such as semicon- 
ductor assembly, a 200-ms penalty would be prohibitive, since the additional time 
would reduce the process yield to unprofitable levels. 

Although a vidicon camera sensor is not inherently a raster-scan device, the 
raster-scan format creates economies in manufacture (i.e., inexpensive cameras on 
the order of $200) and of course provides a simple mechanism for viewing the 
scene using ordinary television monitors, also relatively inexpensive. 

Random-access scanning photomultipliers (image dissectors) are also avail- 
able, but the photoelectric device is more expensive to manufacture (approximately 
$1000 for the tube itself) and the control circuitry is more complex because of the 
random-access requirements. Since this tube does not rely on the conventional 
raster scan, interesting variations such as spiral scans or radial scans may be im- 
plemented. Viewing the output of such a device would require a more costly 
monitor that is capable of accepting both raster and random-access inputs, with 
some type of mode switching required. 

In addition to vidicon transducers, several types of solid-state cameras are 
available (e.g., photodiode and charge-coupled-device cameras). The solid-state 
camera is manufactured in a fashion similar to large-scale integrated circuits. The 
sensor elements themselves are very different from the photosensitive elements in 
a vidicon camera, but the arrays are still accessed in a serial or raster fashion. For 
this reason the solid-state cameras have no access-time advantage over the vidicon 
tube cameras. The solid-state arrays are inherently less noisy than the vidicon 
cameras, but are also considerably more expensive. This price/performance trade- 
off between the camera types must be carefully considered before final selection 
of a photo-optical transducer is made for a particular application. Many appli- 
cations require the solid-state sensors because of weight and noise factors. This 
would be particularly important if it were necessary to mount the camera near or 
on the end effector of a robot. 

Two-dimensional arrays (similar to line arrays) may be formed using either 
CCD (charge coupled device) or CID (charge injected device) technology. Both 
of these sensors are based on MOS (metal oxide semiconductor) transistor tech- 
nology. Since they are discrete in nature, these devices will have a finite number 
of cells in both the horizontal and vertical direction. The solid-state array sensor 
is also an integrating detector and thus it is apparent that its sensitivity is propor- 


tional to exposure time. a . . . 
It is important to understand how video information from the two-dimensional 


array is acquired. In the case of the CCD the most popular topology used is the 
frame transfer (FT) structure. FT technology makes use of an imaging area which 
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TABLE 6.2.1 BRIEF COMPARISON OF CAMERA 
TECHNOLOGIES 


Feature/specification Vidicon CCD CID 
Resolution l 2 2 
Sensitivity (light levels) 1 2 3 
Speed 3 2 1 
Bloom 3 2 1 
Size 2 1 1 
Reliability 2 1 1 
Current cost | Z 3 
Future cost Z 1 3 


—————— 


Source: Tech Tran Consultants, Inc., Lake Geneva, Wis- 
consin from their report, ‘Machine Vision—A Summary 
and Forecast.”’ 


1s exposed to light and generates charges proportional to the integral of the light 
intensity. There is also a storage area having the same number of cells as the 
imaging area. During the ‘“‘frame time’”’ when the image area is exposed, charge 
is accumulated at various cell locations in the array. After proper exposure, but 
before the next frame, this charge is clocked up to the corresponding cell in the 
storage area. (Note that the storage area is shielded from light.) A transfer 
register that permits each row of data to be moved in a serial manner is utilized 
in the operation. While the imaging area is being exposed for acquisition of the 
next frame of data, the charge pattern of the previous frame can be read out from 
the storage area by means of the readout register that operates in a manner similar 
to the transfer register. 

In contrast to the CCD device, the CID camera may be thought to consist 
of a matrix of photosensitive cells arranged in rows and columns. As opposed to 
the CCD technology, each of the cells can be addressed randomly although com- 
mercial implementation relies on scanning compatible with raster techniques. After 
each cell is read, it is reset and begins integrating light for the next frame. Since 
the CID does not utilize the frame transfer structure of the CCD array, there is 
no delay between the electrical signal representing the image and the readout of 
the accumulated charge of a CID device. 

Solid-state imagers also exhibit blooming. In this case, the charge carriers 
generated from an extremely bright part of an image spread to nearby elements 
because those elements located in the bright area are saturated. This charge travels 
to nearby locations thereby causing false information to be delivered to the vision 
system. In general, CID sensors are less sensitive to blooming than CCD-tyPe 
sensors. 

Table 6.2.1 is a brief comparison of the three major technologies used 0 
implement cameras for image acquisition. Note that the ranking is from e 
with 1 representing the best performance. 


First 
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6.2.3.1 Camera transfer characteristic 


The transfer characteristic of a television camera (tube or solid state) can be 
defined by the parameter ‘y given by: 


Y = log(I/I,)/log(E/E,,) 


where J denotes the signal current from the sensor, E the illumination on the 
photoconductive device, and J,, and E,, are respectively the value to which the 
signal and illumination are referenced. 

For non-unity gamma, the contrast in the darker part of the picture is com- 
pressed while the lighter portion is exaggerated. Most television cameras are 
designed with y = 0.45. This is the result of the natural characteristic of the 
CCTV monitors used to view the output. Normally, such monitors have a gamma 
> 2. Thus if the camera is adjusted for the inverse (i.e., y = 0.45), the picture 
on the monitor is pleasing to the eye. Unfortunately, while the image may appear 
pleasing to a human being, the signal provided to a computer will not contain the 
correct information. This is why it is extremely important to use a camera of unity 
gamma for imaging a scene for a vision application. 


6.2.3.2 Raster scan 


Previously, it was mentioned that the electron beam in a vidicon is scanned 
across the photosensitive element in a raster fashion. Figure 6.2.6 illustrates how 
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Synchronization 
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(c) 
Figure 6.2.6. (a) Raster scan process on a television monitor; (b) magnified view 


of interlaced raster scan showing odd and even field lines; (c) two lines of analog 
Video data. 
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TABLE 6.2.2 UNITED STATES 
MONOCHROME TELEVISION STANDARD 
RS-170 SPECIFICATIONS FOR RASTER 
SCAN 
ee 
Parameter Value 
ee nr re a ae ee 
Aspect ratio 


(width to height) 4/3 
Lines per frame 525 
Line frequency 15.75 kHz 
Line time 63.5 ws 
Horizontal retrace time 10 ws 
Field frequency 60 Hz 
Vertical retrace 20 lines per field 


eee 


the raster scan would look on a television monitor. Examination of the figure 
shows that the beam starts at the top left and is moved across the face of the tube 
at a slight downward angle until it reaches the right side. Once at this location, 
it quickly moves back to the left and once again travels toward the right. 

The process just described defines how a picture is recreated on a monitor 
or television screen. The picture consists of a frame that is made up of two fields: 
the odd and the even. This type of raster scan is referred to as interlaced scanning, 
where the even lines are first traced out, then the odd ones, then the even, and 
so on. The interlacing of the two fields is used as a method 
with moving objects to appear with minimum flicker. 

Certain standards exist to define the signal associated with the Output of a 
television camera and its subsequent reproduction on a monitor or television screen. 
As mentioned previously, the RS-170 specification is used in North America. Pa- 
rameters used in a raster scan process are summarized in Table 6.2.2. Essentially, 
this standard specifies a 525-line, 60-Hz format for the video signal. Recall that 
raster scan devices produce serial data that repeat with a given period. Thus 
information about a particular point in the field of view may be inspected period- 
ically at a certain rate but may not be accessed randomly. 

Figure 6.2.6 also shows a representation for two lines of video. A complete 
frame consists of a more complicated waveform with additional pulses for syt- 
chronization of the fields and blanking pulses to ensure that the beam is turned 
off (blanked) during the time it is retracing. At this point, it is important to —o 
that whatever type of imager is used (vidicon family, CID, or CCD) the a 
signal corresponding to lines in a frame (odd and even fields) is essentially tha 
shown in Figure 6.2.6 with the parameters defined in Table 6.2.2. 


to permit pictures 


6.2.3.3 Image capture time 


- : ‘ . ‘mage 
An important parameter associated with image sensors is the actual ssi 
capture time. ‘This can be defined as the time from when an object to be v! 
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is motionless to the time when the RS-170 video signal representing the scene 
contains both the odd and even fields (with valid data). To this must be added 
the time that it takes to store the image in whatever type of vision system is being 
used. 

Image capture time is dependent on the type of sensor and lighting. Consider 
a CCD camera fixed in space and looking at an area into which an object is moved 
by means of some mechanical device (such as an x-y table or conveyor). The 
camera, by its nature (integration of light levels) must be continually scanning. 
Since there will be a settling time for all mechanical motions, the instant when the 
motion of the object ceases will not be synchronized with the start of a field. 
Additionally, and as described previously, a frame transfer CCD camera transfers 
its image to a storage area which can be read out only when the next image area 
is scanned. Referring to Figure 6.2.7, it can be seen that the worst-case time for 
image capture with a CCD is 83.3 ms. It should also be apparent that if the object 
is motionless for at least three field times (enough to read out any invalid video 
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Figure 6.2.7. Image capture for a CCD camera at the time when an object stops moving. 
Note: 33.3 ms must be allowed for integration of each field. 
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data from the frame transfer system), then the image can be captured in two fig) ; 
times (or 33.3 ms). That is, the data coming from the camera will be valiq after 
three field times and the capture time is that needed to obtain both an odq and 
even field. _ 

The same type of analysis can be performed for a vidicon where the lag time 
must be taken into account. The CID camera does not have a frame transfe; 
architecture and therefore once the image 1s stationary, the video is available 
immediately. Its worst-case image capture time 1s 3 fields or 50.1 ms. 


6.2.4 Volume Sensors 


Volume sensors, providing general three-dimensional information, are not yet cur- 
rently available on the market as a standard item. There are mechanisms that 
may be used to measure three-dimensional shape and orientation properties of 
solid objects. Stereo imaging using multiple two-dimensional arrays to image the 
object may be used. Three-dimensional information from solid objects may also 





Figure 6.2.8. Schematic representation of a triangulation range finder. A point 
or line source of light illuminates objects directly below it, while the camera (in 
this case a line array) is set at an angle with respect to the light source. The 
camera “sees” the ray reflected from an object directly beneath the light. When 
no object is present, ray Aa intersects one end of the line array, while an object 
of height D causes ray Dd to imtersect cell d at the opposite end of the array. If 
data relating the actual physical heights A, C, and D are known along with the 
address of the corresponding illuminated cells on the line array, then the following 
relationship may be used to solve for the unknown height B, given b (the line array 
cell illuminated by the light reflected from the object of height B): (AC/AD)/( BC/BD) 
= (ac/ad)/(be/bd). 
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be obtained by use of directiong 
niques are becoming practical 


of three-dimensional features is not yet solved in general 
purpose stereo vision for robots is currently available 


Structured light may be used for the location of various surfaces of objects. 
More discussion of this topic is given in th 


discussed € following section when illumination is 
l ’ 


6.3 IMAGE REPRESENTATION 


Currently, most vision for robotic Systems is not stereo 


our discussion to representation of images as one observes on a television monitor. 
This is best described as an image intensity function of two variables, I(x, y), a 
real function of two space variables (x, y), which corresponds to the light intensity 
falling on the photoelectric target. The intensity function is used to represent an 
image, such as shown in Figure 6.3.1. 

I(x, y) is an idealized image representation and does not account for commonly 
occurring natural distortions, such as lens geometric aberrations, beat frequencies 


between source and scanner, and noise in the scene illumination. A 
image description is 


Scopic, so we will restrict 


more complete 


V(x, y) = i(x, y)R(x, y) (6.3.1) 


In this representation, V(x, y) is the received visual or video information, for 
example, at the face of a vidicon target. The function i(x, y), in this case, represents 
the illumination function that corresponds to physical illumination by some incident 
energy source (e.g., visible light). R(x, y) can represent a reflectance function if 
we are imaging by reflectance, or a transmittance function if the object is being 


Figure 6.3.1. Example of an intensity 
function J (x,y) for an image. One side 
of a cube (e.g., the three side off a die) 
is shown. 
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transilluminated (e.g., as a slide or transparency would be projected), In gen 
R(x, y) contains the information-bearing portion that will be of interest in th. ea 
vision system. Frequently, the illumination source 1s designed to be Constant |; 
i(x, y) = k], so that the measured signal V(x, y) In Eq. (6.3.1) closely Matches the 
desired image function R(x, y). The image illumination i(x, y) may be Manipulat 
SO as to take advantage of some natural property of the scene. For example a 
may illuminate the field with red light so as to bring out certain ‘“‘red”’ Portions o¢ 
a scene and to subdue other “less red’’ features. Ome can accomplish a simila 
effect by placing a red filter in front of an imaging lens. Other illumination 
variations may be designed to light a portion of the scene, for example, with a line 
of light, so that only certain edges or aspects of a field being viewed are imaged 
Illustrations of this are the structured vision system developed for use with robo, 
by the National Bureau of Standards (see Figure 6.3.2), the General Motors Con- 
sight system, as well as several commercial products (see Figure 6.9.1). 

The image function V(x, y) in Eq. (6.3.1) represents a continuous measure. 
ment of intensity, as a function of the horizontal and vertical space variables x and 
y. In Figure 6.3.1, the x axis was oriented from left to right, and the y axis from 
top to bottom. This convention is taken from the normal raster scan of television, 
where the scan progresses from upper left to lower right. The television type of 
image scanner naturally digitizes the y axis, since the raster scan generates only 
individual horizontal scan lines. In the American Standard, there are 525 indj- 
vidual horizontal lines. Of these, approximately 40 do not contain active video 
information from the scene. These 40 are used for timing and synchronization 
and consequently only about 485 lines of valid image information are available. 
The natural quantization of the y axis can be extended to the x axis, so that the 
intensity elements of a field will be defined at discrete points in space. This has 
an obvious advantage if the image is to be processed digitally, as is the case with 
almost all robot vision systems. Finally, one may digitize the intensity amplitude 
in addition to the x and y coordinates, so that the entire picture is digital in nature. 
The picture in this form is said to be made up of individual picture elements, or 
pixels. Each pixel’s intensity is said to be its gray level, since the intensities have 
a value from “‘black”’ to “white.”” Figure 6.3.3 shows a representative digitization 
process for the picture elements for a rectangular letter ‘“‘O”’. . 

The question of sampling density must be raised since there are considerations 
of the sampling rates that must be made. The other physical components of the 
imaging system (e.g., the lens and target) may cause the image formed on the 
target to be imperfectly focused. This will cause the scanning system to — 
information from a finite-sized aperture. This and other effects limit the spae 
resolution, usually to a degree that does not cause problems with regard to UP 
dersampling the image components (i.e., does not violate the Nyquist sampling 
theorem). 

The amount of digital data that is used to represent the image var 
Although 525 lines are available from the raster-scanned image, the x and y ss 
are typically digitized from 64 to 512 pixels. The number used for (x, Y) S!2!" E 
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Figure 6.3.2. (a) Structured light imaging for the NBS robot vision system; (b) 
example objects and the line segment pattern formed by a plane of light for a box 
and an object with both a raised and depressed surface. In all instances, a dark 
line represents reflected light and is the only image “seen” by the camera. 
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Figure 6.3.3. Digital picture representation and data readout. The Signal from 
the output register is shown for row 5 or 6. 


often chosen to be an integral power of 2, and often a representation consisting 
of less than the full resolution is adequate. These decisions are judgmental and 
require analysis of each specific application. This would then require a matrix of 
pixels from 64 x 64 to 512 x 512 (i.e., from 4096 to 262,144 picture elements), 
The intensity quantization is usually from 1 to 8 bits, so the amount of memory 
required for storing images typically ranges from 4096 to 2,097,152 bits. Trans- 
lating this into 8-bit bytes means that from 512 to 262,144 bytes must be available 
for storing images. In most of the image systems available, the images are stored 
in ‘‘video RAM” (random-access memory) on the order of 128 x 128 to 512 x 
512 pixels. Each of these pixels may be from 1 to 8-bits. Since these data are 
usually acquired in 16.67 ms, the data rates are on the order of 2 megabytes/s 
(up to 7.8 megabytes/s for a 512 x 512 image at 30 frames/s). (A frame consists 
of the 525 lines scanned by the vidicon camera. Every frame is composed of two 
interlaced fields, each consisting of 262.5 lines.) 


6.4 HARDWARE CONSIDERATIONS 


An exhaustive treatment of hardware for vision systems would require hundre 
of pages, so our attention will be focused on the major considerations. — Once elt 
the consequences arising from the use of standard television specification 
direct our primary discussions. We will also briefly treat some nonstandar 
situations. | 
Since commercial television cameras are serial access devices, and since we 
vision system processing will require random access to the picture information, | 
commonly encountered problem is the storage of pixels for future reference: 


mos! 
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enerally requires an analog-to-digital (A/D) converter in a configuration similar 
to that shown in Figure 6.4.1. 

The pixel information must be sampled and digitized so that the information 
may be made available to a computer or microprocessor. The A/D subsystem 
essentially matches the rate at which video information is available to the rate at 
which a computer can acquire it. If we are dealing with 262.5 lines per field, the 
sampling period required is approximately 240 to 300 nanoseconds (one line/256 
pixels = 62.5 ws/256). Unfortunately, ordinary microprocessor components can- 
not directly keep up with this data rate since typical ‘instruction times are in the 
range of 0.1 to5 ps. This mismatch in speed may be compensated for by sampling 
more coarsely, and taking more frame times to accumulate the picture information. 
For example, one may use components with a long time constant and sampling 
aperture and sample only one pixel every other frame (assuming that the raster is 
interlaced), the digitizer must return to the same field to collect the data from a 
uniform grid of spatial points. If this approach is taken and a 256 x 256 matrix 
of image points is required, the time for image acquisition is 256 x 256/30 = 2184 s 
or 36 min., which is obviously unacceptable. One may take a single pixel per line 
and capture 256 pixels per field; the time required for acquisition would then be 
256/30 = 8.5 s, which is much more acceptable but still too slow for practical 
robotic applications. Even if one took 10 samples per line in order to match the 
instruction times of a typical microprocessor, we would still need to return to the 
same line 25 times, so it would require about 25/30 = 0.83 s to acquire an image, 
which is still too long for most practical applications. The generally applied solution 
to the time problem is to use a frame buffer that is capable of storing an entire 
image. These frame buffers, which usually have a built-in digitizer to convert the 
data to digital form, are available off the shelf in a variety of configurations that 
match the bus specifications of almost any minicomputer or microprocessor. Using 
such a device then permits higher-level languages and general-purpose image anal- 
ysis algorithms to be applied to what is essentially a large array of data points. 

In many robotic applications where a manipulator is to grasp an object for 
placement elsewhere, the silhouette of the part is very often sufficient to permit 
orientation of the manipulator. In these situations, the image required for use is 
Said to be binary; that is, the pixels describing the object need only one bit to 
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Figure 6.4.1. A/D subsystem for converting analog video signals to digital gray 
levels. 
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P.6 
describe the presence or absence of light intensity with respect to the 
the object being viewed at that instant. Since it is inefficient to use an 
to store binary pixels, binary images are often stored in a packed format. , 
allows 8 pixels to be stored into each byte, therefore requiring only 8199 byte ne 
memory for each field. (Verification of this is left as an exercise for the read . 
For gray-scale images one may require 32 kilobytes to 64 kilobytes of storage § 
4-bit (16 gray levels) or 8-bit (256 gray levels) images. Even with the use of “the 
storage buffers, image-processing algorithms for robot vision must still he ke 
very simple if software techniques are to be used to process the images because : 
much data must be processed. Even moderately complex algorithms require cop. 
siderable amounts of hardware to achieve sufficient preprocessing for general. 
purpose software to be applied. In some cases the hardware algorithm enhance. 
ments are so sophisticated that there actually is no need to store the image jtseys 
but rather only a set of reduced picture parameters is accessed by the computer. 

In addition to the considerations for image acquisition, the illumination of 
the scene itself influences the hardware considerations. In the simple Cases, the 
lighting may be matched to the color or surface reflectivity of the objects under 
consideration. It may be necessary to use either colored light or colored filters 
to bring out certain features to match the color sensitivity of the camera. This 
often permits certain simple processing to be accomplished at the speed of light 
before the data ever reach the photosensitive target. One should remember that 
the speed of light is finite, and that light has a speed of about 1 ft/ns. By using 
oblique as well as normal perpendicular lighting, one may take advantage of shad- 
ows and surface anomalies, or one may choose to eliminate these effects. It is 
also common to use shutters and/or stroboscopic sources to “‘freeze”’ motion. Since 
the vidicon target is scanned at 60 Hz, motion blurring of moving objects is common, 
and a strobed light source can often be of great use. The principle in use is related 
to the fact that the vidicon will store the electrical equivalent of an image for a 
short time while the scanning is being completed. The strobe light essentially 
freezes the object’s position while the camera stores its reflected light pattern. The 
scanning circuitry then transfers the electrical signal a short time later. 

The appropriate use of transmitted and reflected illumination must be made 
to more easily satisfy the picture-processing requirements by the computing com 
ponents, or there may be no feasible solution to the vision-processing task at hat 
in the limited time available. Again, the structured-light approach of the Nationa 
Bureau of Standards is a good illustration of this principle in a robotics applicatio" 
(see Section 6.9.5,2). 
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6.5 PICTURE CODING 


’ . . 7 fl 
The representation of pictures has been briefly discussed previously. In this re 
we treat the topic more extensively and present the following coding concepts 
represent the most commonly used methods in present practice: 
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e Gray-scale images 

e Binary images 

e Run-length coding 

e Differential-delta modulation 


6.5.1 Gray-Scale Images 


Perhaps the best place to begin the discussion of picture coding is with the simplest 
distributional representation scheme, the gray-level histogram, which ts a one- 
dimensional array containing the distribution of intensities from the image. Figure 
6.5.1 shows a picture and its gray-level distribution. Assuming an 8-bit gray scale. 
the number of gray levels will be 256. One can see that the gray-level histogram 
destroys all geometrical information. This is illustrated simply by noting that if 
the image is rotated by any arbitrary angle, the gray-level distribution will remain 
the same. In a sense, the gray-level histogram is really an image transformation 
of a very simple type, so it is often very useful in evaluating imagery because of 
the enormous concomitant data reduction. For example, the Original image may 
require 65 kilobytes of storage, while the histogram would require only 256 x 16 
bits or 512 bytes, a saving of over 99% (512/65,536). 

The gray-level histogram is related to the probability of occurrence of gray- 
level information. Using this interpretation, there are many useful ideas that 
evolve naturally. The average gray level, in conjunction with the minimum and 
maximum gray levels, can be inspected to decide whether or not the picture has 
an adequate contrast throughout the scene. This could, of course, be done au- 
tomatically and the illumination increased or the sensitivity of the camera increased 
by opening the aperture setting on the camera. 

Other picture properties may be deduced by measuring properties of the 
histogram, such as variance. The variance of a histogram is a measure of the 
“spread” of the distribution of gray values. The gray-level histogram function 
may also be used to determine a contrast enhancement function, so that the overall 
image quality is improved. For example, a simple linear contrast enhancement 
may be specified by amplifying the video signal and altering the offset. The 
mathematical expression for linear contrast enhancement is given as follows: 


new gray level = K(old gray level) + B 
where 


K = amplification or attenuation factor 
B = bias or offset gray level 


The results of linear contrast enhancement are illustrated in Figures 6.5.1 and 6.5.2. 
Figure 6,5.1(a) shows an original poor contrast image with the corresponding his- 
togram shown in Figure 6.5.1(b). The results of linear contrast enhancement and 
the corresponding histogram are indicated in Figure 6,5,2(a) and (b), respectively. 

If one inspects the equation for linear contrast enhancement, it is easy to see 


or Robotic Systems: A Functional Approach 





460 Computer Vision f 
Chap, , 
(b) 
Figure 6.5.1. | Original image and its corresponding gray-level histogram. (a) in- 
tegrated circuit (original image); (b) gray-level histogram of part (a). 
that if K = —1 and B = 0, the contrast-enhancement process becomes one ° 


image inversion or image negativity (as in a photographic negative). 

More sophisticated enhancement techniques may be derived from the his 

m. For example, a procedure known as equalization may be applied ap 
gray 


togra 
Looking at the histogram in Figure 6.5.1, one can see that some 
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(b) 


Figure 6.5.2. Linear contrast enhanced picture and its corresponding gray-level 
histogram: (a) contrast enhanced image; (b) gray-level histogram of part (a). 


levels have a relatively low probability of occurring. If we redistribute the gray 
level to those bits that are relatively unused, we can increase the contrast in those 
ray level ranges where there is crowding of picture information. For instance, if 
the region where the most pixels occur is selectively enhanced at the expense of 
Pixel intensities where few pixels occur, we obtain a more equalized distribution 


462 Computer Vision for Robotic Systems: A Functional Approach Chay 
‘§ 
ng the use of the available display dey; 
tic gain control system (AGC) than 
pecial-purpose circuit measures the On 
usts the system gain to maximize = 
t by the camera. It should be Nites 


ofinformation. In essence, this 1s increasi 
This is similar to the effect of an automa 
would find in a CCTV cameta, whereby a S 
of the input signal and automatically adj 


amplitude of the electrical signal being output by the 
that a robot vision system (i.e., the processing circuitry) would not be affected } 


such an image alteration (since the processing circuitry is a quantitative system not 
subject to the contrast limitations of the human vision system), but the huma 
being who usually sets up the system will have an easier task. Contrast enhance 
ment features are often provided in robotic vision systems, so that the humay 
operator will have more-well-balanced imagery to interact with during the training 
phases during setup of the vision system. 

Other information may also be obtained by evaluating the histogram, Foy 
example, picture saturation may easily be detected by using the minimum and 
maximum gray levels found. The lighting may be controlled automatically to 
compensate for this distortion. The overall focus property of the scene may be 
determined as well, by looking at the range Or the variance of the gray level as a 
function of lens focus position. In fact, an automatic focus procedure can be 
derived using a computer-controlled lens adjustment driven to the maximum range, 
provided that image saturation has not occurred. 

The digital coding of images in gray-scale format is in many ways the simplest 
method, since this coding requires very few intelligent choices to be made. Bas- 
ically, if one prevents the saturation of the picture intensity relative to the digitizer 
and the video amplification chain, the picture representation will reflect the scene 
being imaged. We shall see in the next section that binary image representation 
is very efficient with respect to memory storage, but the selection of a binarization 
threshold is often not a trivial process. 

Gray-level coding requires anywhere from 2 to 8 bits, yielding from 4 to 256 
gray levels. Standard television is specified so that only 10 gray levels can be 
perceived by a human observer, and most commercial television systems perform 
on that order. This means that 3 to 4 bits of digitization is sufficient to pe 
mit the maintenance of ordinary video standards. As far as the human visual syS- 
tem is concerned, a 4-bit picture is visually pleasing, but the discrete gray levels 
due to the digitizing may be noticeable. Under the best circumstances, human 
observers are able to distinguish 6 bits (64 gray levels) of intensity. Figur’ 
6.5.3 shows examples of ordinary scenes digitized with 1, 2, 4, and 6-bits of infor: 
mation. Figure 6.5.4 shows computer-generated gray wedges to Jlustrate sim! a 
effects. 

Gray-scale images may be digitized with little regard to image setup: a 
ever, the memory storage requirements are greater than for binary images: i 
the algorithms for processing gray-scale images are generally much more comp : 
cated and more time consuming than those used for binary image processing: 
will become clearer in the following sections. 
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6.5.2 Binary Images 


Binary image coding requires that each pixel in the original image be coded into 
one bit: therefore the term binary image. In its simplest form, a fixed threshold 
may be applied over the entire scene. Figure 6.5.5 shows an example of such a 
process. Although this binary image appears visually pleasing, and a human being 
is easily able to recognize its content, in point of fact the image itself has been 
poorly digitized since there is an uneven or disproportionate distribution of black- 
and-white regions. In this figure the original subject matter was illuminated from 
one side, so that a significant shadow appears in the image and the selected binary 
image threshold is inadequate. In the case of a more realistic scene for robotic 
vision, this effect causes part of the object to extend past its actual limits, and part 
of the image to be eroded. 

In the case of the binary portrait, it is important to appreciate the fact that 
no single binary threshold would be adequate under the lighting conditions used 
to present the image to the camera. Given this illumination, one could attempt 
to use an adaptive threshold that would adapt to the region locally surrounding 
the pixel to be binarized. One such adaptation technique is to use the local average 
intensity as the threshold. Figure 6.5.6 shows such a method applied to an image. 

Because of the reduced memory requirements for binary image coding, as 
well as the reduced arithmetic requirements when dealing with a 1-bit pixel, many 
of the commercial vision products now manufactured frequently use binary images 
and have, to date, not generally used gray-scale imagery for object identification, 
location, and so on. This implies that shape and geometry factors, rather than 
gray-level textural parameters, are the most used in present-day robotic vision 


systems. 


6.5.3 Run-Length Coding 


Gray-scale and binary coding of images are direct methods for image coding, in 
that both systems maintain a map of the (x, y) coordinates and the corresponding 
intensity information. In the simplest form, this might be an array of intensity 
values, the array being as long as the number of pixels in the image. The term 
“data structure” refers to a representation of data in a structured manner useful 
for implementation and management by a computer system. The data structure 
for gray-level and binary images will be a continuous array in memory, whose index 
value and contents are directly related to a pixel location and intensity value. 
Figure 6.5.7 shows such a data structure for an 8-bit intensity mapped image. For 
this data structure, the location of the pixel under consideration is used to compute 
the index in memory associated with that pixel. In this example, the entry index 
is computed by taking the row number of the pixel and adding 256 multiplied by 
the column number of the pixel. (The row index ranges from 0 to 255, while the 
column index ranges from 1 to 256.) The actual entry value in the array is the 
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(b) 
Figure 6.5.4. Computer-generated gray wedges (scales): (a) 1-bit gray-scale res- 
olution; (b) 2-bit gray-scale resolution; (c) 4-bit-gray scale resolution; (qd) 6-bit 
gray-scale resolution. 
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Figure 6.5.5. Binary portrait image. 





(a) 


Figure 6.5.6. Binarized images using the local average as a binary threshold: (a) 
original gray-level image; (b) original image with a 3 x 3 pixel local average 
subtracted; (c) binarized image with gray values of 124 to 132 mapped to black (all 
other values are white). 
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Entry | Entry | Entry Value 
Index | Value | Size (bits) 


{ 100 8 
2 102 8 
3 103 8 
106 8 

8 


First ; 169 
row ; 


l). 
ne 


Second 
row 


{ 512 


+ 65281 
256th 
rOWw 


' Figure 6.5.7. Simple data structure for 
65536 an 8-bit intensity mapped image. 
pecially for binary images, it is clear that there will generally exist long strings of 
pixels of the same binary value. In this case, a separate entry for each pixel is a 
waste of computer memory. If one simply stores the transition points and the 
string length, a (potentially) more efficient data structure can be applied to the 
images. Figure 6.5.8 illustrates such a “run-length coded” data structure. 

For certain types of images that have a lot of “blobs,” the memory requite- 
ments may be considerably reduced by the use of run-length coding. However, 
images with numerous small features may require more memory storage than the 
direct method. In many robotic vision applications, the use of run-length coding 
does offer a considerable saving. Gray-scale images may also be run-length coded, 
using a data structure similar to that shown above. Ordinarily, however, the run 


lengths are not as long, and memory savings are usually not as great as for binary 
images. 


6.5.4 Differential-Delta Coding 


Differential-delta coding (DDC) may also be used to code gray-scale images more 
efficiently. This coding technique uses the difference between the intensity  @ 
pixel and the previous pixel. In ordinary scenes, the difference between success¥* 
pixels is not very large (on the order of 25% of the range or less), so the num : 
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Entry | Entry Value 
Entry Index | Value| Size (bits) 





1 8 
2 6 
3 6 
; 6 
6 
Entry Index 256 
(Transition 
point) 257 8 
258 6 
101 
103 512 
153 
154 
180 
65536 
Figure 6.5.8. Binary run-length Figure 6.5.9. Data struc- 
coded data structure. ture for DDC. The first 


entry value size of each row 
is 8-bits. All others require 
6-bits. 


of bits to encode the difference is two less than that required to encode the entire 
number representing the intensity. The data structure for this encoding is given 
in Figure 6.5.9. Figure 6.5.7 provides the data for Figure 6.5.9. 


6.6 OBJECT RECOGNITION AND CATEGORIZATION 


The preceding section dealt with the coding of images in a blind fashion, without 
intelligently addressing the issues of analysis of imagery from robotic applications. 
Although coding techniques are important, it is more important to understand the 
need for partitioning or segmenting the imagery from the real world. As was 
stated in the beginning of this chapter, several basic tasks are commonly encoun- 
tered in robotic vision systems such as tracking, identification, and inspection. All 
these tasks require that the particular portion of the scene to be operated on can 
be extracted from extraneous picture information and can be analyzed efficiently. 
This naturally leads us to the two topics that will make the realization of these 


goals more likely: 


e Dimensionality reduction 
e Segmentation of images 


6.6.1 Dimensionality Reduction 


s using binary or gray-scale intensity coding results in 


The direct coding of image 
d and somewhat large (from 8 to 65 kilobytes 


Storage requirements generally fixe 
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PB. § 
and more). Run-length coding and DDC generally reduce those fi 
used for appropriate imagery. These types of storage are still rather qr When 
Irecy . 


that they are coding the pixel values as they are found. There IS NO bac; .” In 
ligence embedded into the numbers stored to represent the picture. I IC inte]. 
the images have been memorized, a photographic memory if you will, “ene, 
know that those with photographic memories may not Possess the wisdc © all 
the information in an intelligent fashion. In a sense, the coding Meets Use 
up for the lack of intelligent coding, by brute force. Once all the hae aes 
image have been acquired, use must be made of the pixels to represent the Ne the 
of the image rather than just the arrangement of the pixels. The descr; me 
the content of an image will generally yield a simpler description of an = of 
within the image field of view. For example, one may describe an egg’s of; tee 
on a table as: — 


“egg is located at (Xo, yo) 


egg is oriented at an angle 0 
egg short diameter is d,”’ 


This structured description of the egg’s location is obviously much more 
efficient than the pixel description, and represents a significantly reduced dimep- 
sionality description. However, these efficient descriptions would have little mean- 
ing out of the context of the example, whereas the pixel description would be more 
universally understood. 

In a sense, this new data structure has been designed for the problem or 
product under consideration. General methods for dimensionality reduction do 
not exist that are useful in all circumstances, but there are some methods that will 
be useful in many problems. This is discussed in the next two sections. 


6.6.2 Segmentation of Images 


The dimensionality-reduction concept implies that the image must be processed in 
the context of specific situations. The development of a self-teaching general- 
purpose vision system is a very remote dream. It may someday exist, but for the 
present we must be satisfied with systems of a rather limited scope, albeit with 
high performance. 

To develop an understanding of such high-performance systems, it must b¢ 
understood that the reduction of dimensionality of images is an integral part © 
creating high-performance vision systems. If these systems were required to proc 
ess all the pixels in a sophisticated fashion, the amount of computation time oe 
or special-purpose hardware would be prohibitive. By reducing the dimension : 
of an image to a few salient features, we can then afford to spend a relatively . 
time evaluating those features. To assist in this dimensionality reduction, we ol 
develop mechanisms to isolate “regions of interest” (ROIs). Isolation of the 
is generally referred to as image segmentation. 
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Segmentation can be attempted by many different techniques. We will treat 
the following methods: 


e Color or gray level 

e Edge detection 

e Texture 

e Regionization and connectivity 


6.6.2.1 Color or gray level 


Frequently, the color of an object is useful in separating it from other objects 
for the purposes of analysis. With proper lighting and proper filters in the optical 
path of the image sensor, one can often highlight the desired portion of the scene 
in order to accomplish segmentation. 

Gray-level segmentation is also frequently used for image segmentation. For 
instance, the reflected light intensity from the surface of an egg can be used to 
define a ROI (region of interest) that separates the egg from the rest of the scene. 
Some of the more common techniques used in robot vision systems are silhouetting 
by backlighting of opaque objects, and floodlighting a scene to be analyzed so that 
the object is clearly well separated from the background. 


6.6.2.2 Edge detection 


Another popular and effective method of image segmentation is edge detec- 
tion. In general, edges are portions of the image that have a high spatial variation 
of gray level. Not all such areas of high spatial variation contain edges. For 
example, in a scene with “‘salt and pepper’’ noise contamination, the spatial var- 
iation of gray levels will be high, yet there may not be a real corresponding edge 
in the scene. Assuming, however, that the imaging system has been set up with 
care, the use of the ‘‘edge emphasis” function may generally be useful in defining 
edges, and consequently used to isolate an object of interest. 

There are numerous approaches to edge detection [5], but we shall consider 
some of the simpler algorithms only. The procedures to be specifically considered 
are: 


e First difference/one-dimensional methods 
e Sobel operator 
e Contrast operator 


Each of the operators requires consideration of at least two pixels; thus the 
local subimage shown in Figure 6.6.1 will be used. The local subimage matrix is 
interpreted as follows, A through I are intensity values [Le., I(x, y) values of the 
local image]. ‘E”’ represents the (x, y) location of the Image point under consid- 
eration and A through D and F through I are E’s neighbors. 
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D E F Figure 6.6.1. Local subj 
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The first difference/one-dimensional operators are of th 

e follow; 
a O lowing Sener, 
Edgel = |I — E| + |E - Al 


Edge2 = |F — E| + |E — D 
Edge3 = |H — E| + |E - B 
Edge4 = |G - E| + [IE-C 


Edgel computes a first difference function in the “northwest:southeast” direc; 

This particular edge function is most sensitive to edges perpendicular to the a. 
rection or orientation of computation and essentially returns a magnitude of od 
in only one spatial direction. The functions Edge2 through Edge4 compute a 
similar type of one-directional edge property. Figure 6.6.2 shows the effect of the 


directionality biases of these operators. 
The operators as shown above also incorporate some image smoothing, since 


they accumulate two measurements of edge contrast and then add them together, 
This type of operator will diminish the effect of an errant intensity point. 


(b) 


(d) 





(c) 
Examples of one-dimensional edge operators on two images: (a) 
difference; (4): 


Figure 6.6.2. 
original egg; (b); original integrated circuit; (c) Edge2 horizontal 


Edge3 vertical difference. 
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Figure 6.6.3. E 
V.J- xamples of Sobel _ 
egg; (b) Sobel diff and modified Sobel o oe 
Sobel operator applied wi = erator applied to the ses atary ae 3 
in parts (b) and (c). e image in part (a); (d) difference Sh cia me fea 
ges 


The Sobel o ; 
perator [5 
Hows: [5] incorporates edge information in two direction 
S as 


Edge = 
ge (A +2B+C-G-2H-IP+(A+2D+G—C-—2F— Ip)" 


This operator computes a weight 
of the subi ghted-average intensity function 
other. nth ane then forms two edge measurements ce ro nego 
ment, “The Sobel a oe ee then combined in a “quadrature” me ac 
Gaede a disor: We S sailid generally enhances edges in an acceptable fashion. 
square-root operati s built-in smoothing of the local region. The squarin and 
this operator a - aie = Liha Mame consuming, so one normally would posi 
sean wha te y replacing the squares with absolute values, and eliminatin eA 
ha in toto. ‘This 1s referred to as the modified Sobel operator re . 
ns of the Sobel and modified Sobel operators are shown in Figure é é ial 


6.6.2.3 Contrast operator 


Another approach to edge detection ‘s the use of contrast differences. Con 


sider the following: 
as oR Ee eee 
central pixel to the pixel’s surrounding 


s the intensity of the 
en the central pixel and its neighbors 


This operator compare 
contrast betwe 


Here, only the difference in 
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Figure 6.6.4. (a) Original 8-bit image; (b) contrast operator applied to the original 
image that was offset by 128 to avoid negative numbers; (c) gray-scale histogram 
of part (b); (d) binary image of part (b) with gray values of 124 to 132 mapped to 
black (all other values are white). 


is considered, regardless of the distribution of the neighboring pixel intensities (see 
Figure 6.6.4 for examples). 

The use of edge operators, as described above, can be used to expedite 
segmentation of images. For example, given that edge information is available, 
the extent of the object of interest may then be defined. The edge detection 
functions defined above have the property that they may be computed sequentially 
as the image is scanned (i.e., their need for random access to the image contents 
is minimal). The disadvantage to these procedures is that they characterize only 
edge points, and do not characterize edges. This isan important distinction because 
the edge points that are located are done so independently of each other, and there 
is no explicit or implicit connection among them. These techniques are useful, 
however, as implied above. For example, if one is scanning with a raster scat, 
the detection of an edge point may be used to activate another procedure for 
bounding the object of interest. In many cases, simply knowing the extent of the 
object in two dimensions is a good first step toward reducing the dimensionality 
of the image to be analyzed. 

As there are serial- or sequential-access edge algorithms, there are also ra" 


dom-access edge tracking procedures that may be used for segmentation. One 
such procedure is a contour-following procedure. 


6.6.2.4 Contour following 


on ee ol 
In contour following it is first assumed that we can determine whether ake 
a test point Is interior to a region or exterior to it. A simple binary thresh 
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technique may be appropriate for segmenting an object from the background, or 
alternatively, an edge detection function as described previously may be used to 
define a band of pixels surrounding the object. Another possibility would be the 
use of an adaptive threshold, as described in Section 6.5.2. 

Contour following utilizes the following technique: 


Find an edge point (between two pixels), and consider two test pixels diagonally 
ahead (with respect to the direction approached) of the current position. These 


pixels will be used to test if a candidate edge point is inside or outside of the 
region. 


If the current point is inside the region, i.e., both test pixels are inside, 
turn left until the region is exited. 


If the current point is outside the region, i.e., both test pixels are outside, 
turn right until the region is entered. 


If the current point is indeterminant, i.e., one test pixel is inside and the 
other is outside the region, go straight. 


This procedure is graphically illustrated below. (Note that ‘‘x” marks pixels in- 
terior to the region and “‘o” marks pixels exterior to the region. Also, the ‘‘x” 
and the ‘‘o” are the only two pixels under consideration at the present time.) 


X 
———  ; indeterminant —— go straight ahead one step and 
O test next two pixels. 
O . 
———— ; indeterminant—— go straight ahead one step and 
Xx test next two pixels. 
O . 
———] +: outside object —— turn right and test next 
O | two pixels. 


X 
_* i - inside object > __ turn left and test next 
X | two pixels. 


Figure 6.6.5 shows an example of contour following. In this example, the 
Starting direction is toward the right at coordinate location (3,9). The dotted line 
then indi tour path followed. | | 

: ait cee eee method is capable of following closed regions well, 
but will also follow any nook and cranny that exists in the contour. It must be 
emphasized again that proper original scene illumination can make the difference 
in any algorithm used to perform the required task. 
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6.6.3 Object Description, Categorization, and Recognition 


Although the types of segmentation described in the preceding section are not the 
only types, they are often used for the purpose of isolating objects. Once objects 
have been segmented from the extraneous information in the scene, numerous 
methods can be used for object description, categorization, and recognition. There 
are two very common description techniques for objects. If the object is one that 
requires shades of gray to characterize it, the object will simply be described by a 
pixel map, with sufficiently high pixel resolutions in both space and light intensity. 
This description is not especially efficient but it is useful for comparing a known 
object with a test object. 

The more usual situation is with objects that do not require gray-level de- 
scription (i.e., a binary description is sufficient). In this case the outline of the 
object, along with interior holes, is sufficient. If an object has different mechan- 
ically stable states, several different outlines will be necessary to describe the object 
properly. It must be made clear that the outline that may be used to describe a 
binary object must have a data structure that is amenable to storage in digital form 
for later reference. One especially simple data structure is an ordered list of the 
(x, y) coordinates of the outline, but this is not very efficient or convenient. 

Another more useful data structure for encoding the outline of an object 6 
the chain code. Here a sequence of unit steps is utilized in one of the four OF 
eight directions that may be traversed in reaching the next point on the outline. 
Such a coding scheme is illustrated in Figure 6.6.6 for a simple object. In this 
example, eight directions are used, and the ‘**” represents a point on the outline: 
Note that starting at different points on the outline gives different chain codes, 
they can be reconciled with software techniques that are beyond the scope of tH 


presentation. 
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Start at ------ > + ##R HHH 
“a ’ * ata 
the “’ + * * 
eal 
and proceed ne 
clockwise 


Chain code= < €,€,€,€,€,€,€,Se,S,S, 
W,W,W,W,W,W,W,Nw,n,n> 
where 


€ = east 

Ww = west 

nN = north Figure 6.6.6. Chain code example. 

S = south Starting at the ‘“‘+’’, the sequence of 
ne = north-east pixel moves that defines the outline of 


an object is represented by the direction 
abbreviations shown within the < >, 
i.e., 7 east, 1 southeast, 2 south, 7 west, 
Sw = south-west 1 northwest, and 2 north. 


se = south-east 
nw = north-west 


The use of gray-level or chain code object memorization is a simplistic ap- 
proach to object description that is used in practice. However, one must recognize 
that description is only part of the problem. Given that a “master drawing” of 
the objects of interest is available, the real problem is to accomplish recognition 
of a new object. For example, assume that a known good part is available for 
characterization. The part would have to have some properties measured and 
stored. The outline and gray scale pattern of each mechanically stable state would 
also have to be memorized. 

It can be shown that these simple data structures for object description require 
a significant amount of computer time for implementation (see Problem 6.7). The 
solution of the rotational and translational problems requires a three-dimensional 
search and comparison with the master drawing. To reduce the complexity of 
comparisons, it is very common practice to use less than complete geometrical 
descriptors or “‘features” for object characterization. 

The most common techniques simply use parameters such as: 


e Size or area 

e Range of object projected onto x and y axes 

e Ratio of the extent of the object in the x and y directions 

e Center of gravity of gray scale or binary rendition of object 
e Geometrical moment description 

e Number of holes in the object 


Figure 6.6.7 illustrates some shape and geometry features commonly used in 
object description. These features clearly reduce the dimensionality required to 
characterize the objects and will reduce the computation time for object identifi- 
Cation. Since the dimensionality of the descriptions 1s reduced, we should expect 
to trade-off something in return. In fact, we will find that these features do not 
uniquely characterize the object, so there exist an unlimited number of different 


480 Computer Vision for Robotic Systems: A Functional Approach 


Area \ 
Excluding | | f 
Holes 7 Q 
Interior Area 
(Area of holes) 


Longest 
Dimension 


Feret’s 
Diameter 
Breadth | | 


_—_—P 


©) | 
Oni 
Perimeter LI 


Chap, 


NS 


Convex 
Perimeter 


OA oO 
of 





Projected 
Length 
Maximum 
Horizontal 
Chord 
Examples of Derived Size Measurements 
Derived measurements Significance 
Area excluding holes + Area of holes Total area of feature 
Convex perimeter / x Average feret’s diameter 


Average feature width 
Area/longest dimension at right angles to 


the longest dimension 


a x Area/perimeter Average chord length 


a X Area 
Equivalent cylindrical volume 


LSNIN 


4 x Longest Dimension 


; ‘ 
Figure 6.6.7. Commonly used shape and geometry features. Redrawn with pe 


mission of Dynztech Laboratories, Inc,, Imaging Products. 
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objects with the same parameters. Fortunately, in a teal robotics application. we 
will know if these cases exist and add additional features to remove ambiguity. 
One good method for categorizing an object is to derive a feature vector (I.€.. 
a set of measurements describing the object) and then to compare that set with 
the known good set. The differences or error between the two vectors may be 
used to decide if the test object is in the same category as the object used for 
training. Obviously, this would have to be done for each stable state. Such a 
process 1s known formally as the ‘nearest-neighbor technique” [4] and is one of 
many Statistical pattern-recognition techniques used for categorization. Unlike 
many statistical pattern-recognition problems, most robotic vision problems are 
not usually very statistical in nature, since the system designer can exert control 
over many processes (i.e., the engineer is often able to “design for automation’ ). 


6.6.3.1 Image comparison 


In many applications, a reference image or sub-image is available. The 
reference or standard sub-image may represent the object to be located in sub- 
sequent test images. The sub-image is frequently used as a mask or memory 


engram for comparison with incoming test imagery. This search task may generally 
be described as: 


O(x0, Yo) = G{T(x — Xo, Y — Yo), Hx, y)} 


where 
T(x, y) = reference sub-image 
t(x, y) = test image 
(Xo, Yo) = Spatial translation offset 


O(Xo, Yo) = Output response 


G{-} is referred to as the comparison operator. 
Frequently, G{-} is chosen as a linear, two-dimensional convolution operator. 
Alternately, it can be defined as 


Gf} = SIT - x0 ¥ — Yo) — (YI 


thereby representing the sum of the absolute differences of the reference and test 
image as a function of the spatial location of the reference (xo, Yo) with respect to 
the test image. This technique is also known as a ‘nearest neighbor classifier” 
since the nearest neighbor to 7(x, y) in (x, y) will have the lowest score and will 
be the closest “relative.” The summation is carried out over the image region in 
which the sub-image is coincident with a portion of the test image. In general, 
the sub-image is displaced spatially (in both x and y) so that it is placed over the 


entire test image. 
Other on may also be created. One of the simplest is called binary 
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correlation. As expected, both the image and reference are binary in nature. Thi. 
process may be defined as follows: 


e A template is defined. For binary correlation, this is usually part of an image. 
It is important to note that it may take the form of a line, a square, a rectangle, 
or even a disjoint set of pixels (that maintain a fixed spatial relationship to 
each other). 


e The template is overlaid on the test image. Some location on the template 
is chosen as a reference point (e.g., the top left corner). The corresponding 


point on the test image defines the coordinate where the results of the Op- 
eration will be placed. 


e The number (or fraction) of pixels on the template that match the portion of 
the test image over which it is placed are computed. A typical method of 
doing this is to sum the results of the complementary XOR function performed 
between each corresponding template and test image pixel. 

e The value computed above is placed in a resultant image at the location 
corresponding to the template’s reference point. 


e The procedure is repeated until the template has been overlaid on each pixel 
location in the entire image. 


Figure 6.6.8 shows an original binary image, a template, and the resultant 
image after the binary correlation process has been applied. As can be seen in 
part (c) of this figure, the locations where the best match occurs have the highest 
value. Various methods can be used to provide more image data in cases when 
the template extends beyond the image. One possibility is to add additional zeros. 
This was done in the example shown in Figure 6.6.8. Two columns of zeros were 
added (but not shown) to the right of the image and two rows of zeros were added 
at the bottom. Thus the top left edge of the (3 x 3) template could be placed 
on each pixel of the image. 

While binary template matching is quite simple to implement (in hardware 
as well as software), some problems exist. Recall that generally information about 
an image is lost when it is binarized and pixels that constitute an edge must either 
be white or black. Thus accurate positional information may be lost. Addition- 
ally, since both the image and template are binary, it is important to have ap- 
proximately the same threshold and lighting conditions when performing correlation 
as was used to define the template. This is because changes in scene illumination 
(and threshold) may cause the test image to differ from the image used to define 
the template, thereby resulting in incorrect matches or no match at all. 


6.6.3.2 Template matching 

As a matter of interest, the same Procedure used for binary correlation can 
her mathematical Operations on the imagé: 
rred to as template matching. In this case; 
ect some property of the image such as all 


When used this way, the process is refe 
the template (or model) is used to det 
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Figure 6.6.8. Example of template matching applied to a binary image: (a) binary 
image array (15 = 20): (b) binary template; (c) output of binary correlation (14 x 19). 
The dashed box in part (a) indicates a perfect template match has been achieved. 


edge. For example, if both templates shown in Figure 6.6.9 are applied to an 
image and the Square root of the sum of the squares of both process outputs at 
each (image) pixel taken, the edges of the resultant image are enhanced. These 
templates perform the same function as the Sobel operator described previously. 
In this case the reference location of the template would be the center pixel. 


6.6.3.3 Correlation for gray-level images 


The same concept used for binary template matching can be extended to a 
S'ay-level image and model (or reference sub-image). However, in this case it 
Should be apparent that a high correlation could occur for features in the image 
that look nothing like the model due to the fact that they may be brighter than 
ne pixels that match the model. Thus the method of cross correlation may not 

« adequate to uniquely define the feature (part of image that best matches the 
"elerence) that is being sought. a be ak 
If the Fisher statistical correlation coefficient is used, the best match of a 


Siven §Tay-level modelina gray-level image can be found, independent of variations 
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in illumination. Essentially, : 
with the image. By definition the 


maximum value of the correlation of the model 
correlation coefficient is given by: 


NSM — (21,)(2M) 


Xo, Yo) = ——$—$—$ oe 
Po» Yo) = Sa — SiN SM? — (2M) 


where 
I, = a sub-image of the test image which is dimensionally the same 
as the model (or template) 
M = the model or reference sub-image 
N = the total number of pixels in the model 
(Xo, Yo) = the spatial location of the model with respect to the test image 


Note that’ the model can be any size (q X r) with the provision that it is smaller 


than the test image. 
The template or model is moved across the image as described previously. 


However in this case, besides multiplying the corresponding gray levels of the 
template and model, both the average value of the sub-image and the model (and 
the variance of each) are needed. Note that the average value of the model and 
‘ts variance are constant. Variations on the equation above can simplify com- 
putation. For example, the correlation coefficient can be squared to remove the 
burden of taking the square root in the denominator. 

A few interesting conclusions can be inferred from the use of the correlation 
coefficient. First, a value of 1 indicates a perfect match and if values less than 
zero are ignored, the maximum value obtained over the image defines the location 
of the best match. Of course, the higher the correlation coefficient the better the 
match. Second, if a feature in the image is partially degraded, the correlation 
coefficient will still generally identify it and its location. Third, all the locations 
in an image that matched the model could be found by simply looking for all the 
correlation coefficients above some specified threshold. Finally and as state 
previously, the correlation coefficient is independent of linear changes in brightness. 
That is, assuming all the pixels of the image (or the model for that matter) at© 
modified by the function 


I(x, Yew =a I(x, y) + b 


for a > 0 and any 5, the correlation coefficient is unchanged. The parametets ‘ 
and 6 can be considered as gain and offset for either the image or the acquisition 
device. 

If one chooses to make a template that defines some specific feature of an 
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object such as a corner or edge, it is possible to use the gray-scale correlation 
technique just described to find these specific features. In this case, imagine a 
(q x r) model with the left half, q x r/2, entirely white and the right half black. 
Using this template (or model) with gray-level correlation enables one to find all 
the areas of the image that resemble an edge having a light to dark transition. 


6.6.3.4 Morphological image processing 


In morphological processing, an output image is considered as the next gen- 
eration of an input image. Essentially the processing may be carried out many 
times (i.e., the output becomes the input, the input is operated on, and becomes 
the next generation output) to cause certain characteristics of an image to be 
enhanced, removed, or otherwise changed. The operations on an input image 
consist of a set of rules that operate on the value of a spatially specified input pixel 
and its neighboring pixels. The rules generate a value for the pixel in the output 
image having the same spatial location as the input pixel. While morphological 
processing is commonly applied to binary images, it can be applied equally to gray- 
level images. However, there are no equivalent gray operators for each of the 
binary operators. 

To briefly illustrate this type of processing, two of the most common oper- 
ators, erosion and dilation, will be examined. Erosion in its simplest form, replaces 
a pixel by the local minimum of its neighborhood (e.g., a3 x 3 local region). For 
this operator, bright objects will decrease in apparent “‘size’”’ thereby becoming 
“eroded.” (Of course, dark objects will increase in apparent size.) Dilation in its 
simplest form, replaces a pixel by its local maximum, thereby increasing the size 
of bright objects and decreasing the size of dark ones. : 

We will illustrate the morphological image procedure by considering a3 x 3 
kernel. In this case, imagine that each pixel surrounding the center one (as well 
as the center pixel) is the input to a transform rule. This rule generates a value 
of the output pixel which is placed in the output image at the same spatial location 
as the center pixel. Once again we may think of moving the 3 x 3 kernel area 
all over the input image to cover it completely. If we chose the logical AND of 
all the pixels in the 3 x 3 area as the transform rule, then the output will be a 1 
Only if a white pixel is surrounded completely by white pixels. This performs 
€rosion since its effect is to reduce the size of white regions. Note that if erosion 
is applied enough times, it can completely eliminate all the white pixels of an image. 
As mentioned above, dilation is the opposite of erosion and corresponds to using 
the logical OR function for the pixel mapping rule. When it is applied to a binary 
image, the size of a white area is increased. Figure 6.6.10(a) shows an unprocessed 
binary image. Figure 6.6.10(b) shows the results of the white dilation operation 
Performed on Figure 6.6.10(a) while Figure 6.6.10(c) shows the results of a white 
€rosion (or black dilation) performed on the image of Figure 6.6.10(b). 

If one performs erosion operations followed by dilations, small bridges be- 
tween white objects will be broken. This cascaded operation is called an opening. 
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Figure 6.6.10. Example of morphological image processing: (a) original binary image; (b) 


result of white dilation of the image in part (a); (c) result of white erosion of the image in 
part (a). 


The operation of dilation followed by erosion has the opposite effect and closes 
up the spaces between adjacent regions. This cascaded operation is called a closing. 

Many other operators exist which allow filling in partially missing edges to 
restore the original shape of the image, measuring the extent of an image, and 


actually isolating objects and reducing their dimensionality to count specifically 
shaped and sized objects in a scene. 


6.7 SOFTWARE CONSIDERATIONS 


The techniques used for vision in robotic applications may rarely, if eve! be 
implemented totally in software. Virtually all vision systems implement some 
algorithms in hardware. The software considerations lie mainly in the eas¢ ss 
which the vision systems may be used. Most of the present vision systems a!° 


Sec. 6.9 Review of Existing Systems 487 


essence, peripheral devices to the main robot controller and are invoked through 
a command/data Structure that is rather simple. Basically, the peripheral (vision) 
device 1s given a string or stack of commands, and the peripheral returns data to 
the main processor. Some vision systems have their own user languages that range 
from cumbersome to friendly. For the most part, then, language and software 
considerations lie mainly in control of the vision peripheral, not in the actual 
implementation of the algorithms. 


6.8 NEED FOR VISION TRAINING AND ADAPTATIONS 


Although one might initially have believed that the definition of a prototypical 
imaged part is trivial, by now the reader should be aware that the amount of data 
required to define an object may indeed be huge in comparison to other digital 
data-processing applications. When considering the variety of degrees of freedom 
required to describe an object fully, it is evident that vision system training will be 
needed so that a reasonable amount of data may be retained by the vision system. 

It is for these reasons that dimensionality reduction, as mentioned earlier, is 
so important. Specifically, it allows for the efficient representation of the visual 
data, usually in an independent manner. Another important consideration has to 
do with the potential for dealing with objects and parts that may be changing over 
time. For example, a conveyor belt carrying a part may not operate at a carefully 
controlled constant speed. As a consequence, parts will not arrive at known or 
precise intervals of time. In such an instance, tracking of the “trend” regarding 
parts arrival may be very useful in efficiently acquiring images and in processing 
the data. 

Another case where this is true is in semiconductor assembly, where a die 
may be attached to a substrate by a die attach machine. If this machine has a 
slight but consistent drift, the imaging of the die for later bonding of wires to the 
lead frame and chip may be subject to placement errors, due to variable placement 
of the die. This type of adaptive updating of object positions is often necessary 


for efficient part handling. 


6.9 REVIEW OF EXISTING SYSTEMS 


In this section we review the major types of commercial vision systems currently 
available. The discussion of techniques used in these systems will be restricted 
somewhat, since robotic vision requirements may be very diverse. The major 
systems can be classified into the following type of general categories: 


e Binary vision systems (utilizing either preprocessing or classification algo- 
rithms) 
e Gray-level vision systems 
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e Structured light systems 
e Character recognition systems 
e Ad hoc special-purpose systems 


6.9.1 Binary Vision Systems 


Binary vision systems are those that use only two levels of image information 
They are so-called silhouette systems, since very controlled lighting must be used 
to image objects reliably. Backlighting of parts is frequently selected so that the 
objects to be inspected stand apart from the background. The binary vision systems 
are used primarily for: 


e Parts recognition 
e Parts location 
e Parts inspection 


From a visual perspective, a binary vision device may be thought of as being 
able to operate on a part as if an inspector had picked up the part and held it up 
to a light source for backlighted inspection. One can see that there is a limited 
but useful class of information that one can glean from this procedure. 

The SRI collection of algorithms is an example of a binary vision system. As 
typically implemented, it will permit arbitrary angular alignment of the part. A 
run-length-coded image is often produced because of the speed enhancements 
possible (see Section 6.9.5.3). 

For objects where angular alignment is not an issue because of some prior 
orientation stage, but where the translational position is unknown, binary corre- 
lation techniques are often used. Binary correlation permits the object to be 
located with the value of correlation at the best match point often used as a measure 
of part quality. For arbitrary parts orientation this technique is not practical yet, 
because of the need to perform correlation in three dimensions (two translational, 
one rotational). Other binary vision systems frequently use so-called ‘“‘pixel count- 
ing’’ for inspection of parts. These systems usually require spatial windowing of 
data and then counting pixels in those windows. This scheme typically requires 
significant application effort to choose the correct windows, and then requires 4 
Jarge degree of ad hoc adjustment to determine the significance of the pixel counts. 


6.9.2 Gray-Level Vision Systems 


Gray-level systems generally capture 4-, 6-, or 8-bit images, and then apply very 
tailored algorithms designed for a specific application. Gray-level template-match- 
ing techniques, for example, may be used to locate parts in nonsilhouetted ee 
ronments, In many instances, highly controlled lighting may not be permitted, © 
the surface of the object has variable reflectivities that are useful for inspect 
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the object. a aoe comparisons may be used to locate objects that 
are angularly aligned, wit the amount of template differences being used as a 
measure of object similarity, relative to a known “ideal” prototype. 


6.9.3 Structured-Light Systems 


The structured-light approach in general has proven very successful in numerous 
applications (¢.g., see Section 6.9.5.2). We have already seen where backlighted 
objects are easy to analyze for certain types of object characterizations. Structured 
light carries that further by characterizing objects with slits of light, and then 
observing new samples in the same lighting environment. As a slit or plane of 
light falls on an object, various distortions and path deviations of the illumination 
may be seen and may be used to characterize location, orientation, and surface 


details. In addition to slits of light, one may also use “grids” of light and look 
for distortions in the grid pattern to characterize objects. 


6.9.4 Character-Recognition Systems 


It is often desirable to read labels or characters from parts, packages, and so on. 
Where bar codes may be placed on the parts to be identified, identification may 
be accomplished by simple bar-code readers. Alphanumeric codes are a different 
matter entirely, since recognition of arbitrary character sets has until recently been 
a very difficult image-processing task. Several systems available today are able to 


read a wide variety of character sets (after initial training) at high speeds (15 to 
30 characters/s). 


6.9.5 Examples of Early Robotic Vision Systems 


A number of vision systems were developed specifically for use with robots prior 
to 1980. These include the GM Consight System, the one developed by the 
National Bureau of Standards, and also a system developed by SRI. We consider 
each of these in turn. 


6.9.5.1 The GM Consight | system [12] 


In the late 1970s, General Motors Research Laboratory demonstrated a ro- 
botic vision system that was capable of operating in the visually noisy environment 
often found in manufacturing installations. Called Consight I, this system was 
Capable of determining the type, position, and orientation of a part on a conveyor 
belt without the need for enhanced (and often impractical) contrast techniques 
Such as utilization of fluorescent paint on the belt's surface. 

A block diagram of the system is shown in Figure 6.9.1. As can be seen 
from this figure, a minicomputer is used to process the scene detected by the solid 
State linear array camera (e.g., a Reticon RL 256L) that is mounted upstream from 
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Figure 6.9.1. GM Consight I system. 


the robot’s work station. In addition, information about the conveyor’s speed is 
sent to the computer. In the time it takes a part to move from the vision system’s 
location to that of the robot, the computer utilizes the visual and speed data to 
determine the location, orientation, and type of part and sends this information 
to the robot controller via an interface. With this knowledge, the robot is able 
to successfully approach and pick up the part while the latter is still moving on the 
belt. Itis important to note from Figure 6.9.1 that the vision system is not mounted 
on the robot itself and, therefore, does not reduce the robot’s useful payload. 

It is necessary to monitor the conveyor’s velocity continuously for several 
reasons. First, typical moving belts that are found in factories generally do not 
have velocity servos controlling their speed. Thus it is expected that the speed 
will fluctuate due to a variety of causes including load changes, line voltage vari- 
ations, and wear of rotating parts (i.e., increased friction). Since the robot must 
accurately know when the part arrives at its work station, the instantaneous belt 
speed must be available to the computer. Second, keeping track of any belt speed 
variations has to do with the method used to acquire the two-dimensional visual 
scene. This is discussed next. 

As can be seen in Figure 6.9.2, the linear array camera scans the belt in 
one-dimensional manner (€.g., in the y direction) and this is perpendicular to the 
conveyor’s motion (e.g., the x direction). Note that the camera will record 12° 
equally spaced points across the width of the belt. The two-dimensional image '§ 
formed by instructing the camera to wait until the part has moved a specifie 
distance down the conveyor before recording the next line image. It should be 
clear that fluctuations in belt speed can produce distortion in the recorded imag®: 
This undesirable phenomenon is avoided by speed monitoring which permits the 
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Figure 6.9.2. Camera and light source 
configuration in the Consight I system. 
The basic light principle is illustrated. 


time interval between acquiring two successive line images to be varied in order 
to compensate for any non-uniformity in the belt speed. 

How does the Consight System avoid the problem of poor lighting conditions 
without resorting to contrast enhancing techniques? How does the system “know” 
if a part is present or not? The answer to both of these questions is through the 
use of structured light. With respect to Figures 6.9.3 and 6.9.4, it is observed that 
a light source, consisting of a long slender tungsten filament bulb and a cylindrical 
lens, which projects a linear (and fairly intense) beam across the belt’s width is 
positioned downstream of the camera which is placed in a position so that it can 
sense this line of light. When no object is within the field of the camera, an 
unbroken line of light results. See Figure 6.9.4(a). However, when a part is 
present, the three-dimensional nature of the object causes a portion of the light 
beam to be intercepted before it reaches the camera position. When viewed from 


Long Light Tube 


Cylindrical 
Lens 


Focused to 
Line Across Belt 


Figure 6.9.3. Structured (linear) light 
source used in the Consight I system. 
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above by the camera, this part of the line of light that is deflected by the ob: 
appears to be displaced (downstream) as shown in Figure 6.9.4(b). Thus 
camera will sense a black image wherever there is an object and will record a igh 
region where there is no part. As the part moves down the conveyor, the region(s) 
of black will change in length (i.e., y). The two-dimensional binary image recorded 
by the camera will, therefore, consist of regions of black (wherever there is q part) 
and white where there is none. 

One potential problem with this procedure is shadowing, as illustrated by the 
dotted lines in Figure 6.9.5. Here, it is observed that the System will “detect” the 
leading edge of the part before it actually arrives at the camera Position. This 
problem can be solved through the use of two or more linear light sources focused 
at the camera location on the belt as shown in Figure 6.9.5. The reader will 
observe that the second light beam prevents this position on the conveyor from 
becoming dark until the part is actually at the location. 

The Consight System uses a run-length coding scheme for Storing the two- 
dimensional binary image. Since the camera has 128 elements, only 7 bits are 
needed for this purpose. The remaining bit (usually the most significant) in any 
run length “word” is used to indicate whether the transition is light to dark or vice 
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versa. AS mentioned in an earlier section of this chapter, it should be clear that 
unless the object being viewed has many holes, a considerable data compression 
will result from run-length coding and the memory required to store the processed 
data is far smaller than would be needed otherwise. Moreover, it is found that 
processing time in subsequent Steps is also decreased when this technique is em- 
ployed. Edge detection is accomplished utilizing a 6-connected region algorithm 
whereby connectivity is permitted along four sides of a pixel and along one of the 
diagonals. 

Once the object outline has been found, the part must be classified and its 
position and orientation (relative to its leading edge) determined. To do this, a 
small number of numerical descriptors (i.e., features) are computed or extracted. 
Some of the descriptors Consight employs are: 


e Center of area (centroid) 
e Axis of the least moment of inertia of the part silhouette 
e Maximum radius point measured from the centroid to the image boundary 


For a given object, comparing these and other simply computed features with those 
stored in the computer (for the entire “world” of permitted objects) allows the 
part to be recognized. 

Orientation, a descriptor that is usually part specific, can be found in a number 
of ways including selecting the moment axis direction that points nearest to the 
maximum radius point measured from the centroid to the boundary. This de- 
scriptor and the belt speed are then used to inform the robot when the object is 
within the workspace and where and how to grasp the part. In some instances, 
it may be necessary to stop the conveyor for a period of time to permit the ma- 
nipulator to acquire the object. 

A major problem with the Consight system is that it cannot handle parts that 
are touching one another. If such a situation occurs, the number of scan lines will 
usually be greater than for any single part. Alternatively, no match between all 
the features of the two touching parts and those stored in the vision system’s memory 
will occur (e.g., the overall area will generally be larger for the “compound ob- 
ject”). In either instance, the objects that cannot be “identified” are permitted 
to run off the end of the conveyor and into a reject bin where they can be recycled. 
It is important to understand that any object that can assume more than one stable 
position on the conveyor will require a separate set of features to be stored tor each 
one, 

Although the GM Consight was developed over ten years ago, it is still used 
commercially in a somewhat modified form today by the GMF Corporation and 
also by the Adept Corporation under a licensing agreement. 

Having considered the various features of a vision system that was developed 
by a large private company, we next consider a robotic vision system developed 
with Federal money at the National Bureau of Standards. 
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6.9.5.2 National Bureau of Standards vision system [19] 


In the 1970s, the United States Congress charged the National Bureay of 
Standards (NBS) with developing a fully automated machine shop by the latte; 
part of the 1980s. As part of their effort to achieve coordinated control over robots 
and other less sophisticated machine tools (e.g., lathes, punch Presses, milling 
machines, etc.), a need for a vision system that could be used in such an environment 
and could be interfaced with robots was perceived. 

The research effort was undertaken by Dr. James Albus and his colleagues 
and produced a workable system in the late 1970s. The NBS Vision System, as 
it was first introduced, was able to process picture information in less than 100 ms 
and was estimated to cost about $8000. Since then, the system response time has 
been improved and some of the hardware has been modified. However, the basic 
operation technique has not changed appreciably as described next. 

The major hardware elements of the NBS Vision System consist of three 
components: (1) a solid state camera capable of producing 16K pixels (128 x 128): 
(2) an electronic stroboscopic light that emits a plane of light and whose flash 
intensity can be modified digitally; and (3) a ‘‘picture processing” unit. To under- 
stand the operation of the system, consider Figure 6.9.6. [The reader should 
understand that the robot manipulator (in particular, its wrist) is not shown here. 
In actual operation, the camera and (structured) light source would be mounted 
on the robot’s wrist whereas the processing unit would be in or near the robot’s 
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Figure 6.9.6. Structured light imaging for the NBS r 
camera and the flash (strobe) unit are mounted on Opposite sides of the robot’s 
wrist (not shown) such that the plane of light is parallel to the fingers of the gripper. 
The presence of an object causes one or more line segments to be seen by the 


camera. With permission of the National Institute of Science and Technology 
(formerly National Bureau of Standards). 


obot vision system. The 
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Box 


(Front view) (Oblique view) 


Object with Object with Depressed Surface 


Raised Surface (Front view) (Oblique view) 


Figure 6.9.7. Example objects and the line segment patterns formed by the plane 
of light as seen by the camera for the NBS vision system. With permission of the 
National Institute of Science and Technology (formerly National Bureau of Stand- 
ards). 


own controller.] The strobe unit produces a plane of light that is projected parallel 
to the wrist plane (determined by the approach vector and y). The camera is 
mounted above the light source and is tilted down (i.e., so as to intersect the light 
plane). Its 36-degree field of view covers the region extending from inside the 
fingers of the gripper out to a distance of one meter. If the projected light strikes 
an object in this region, a pattern of line segments is formed on the object. See 
Figure 6.9.7. As the robot gripper moves closer to the object, these line segments 
will grow in size and will move down in the camera’s field. Qualitatively, the 
reader should be able to conclude that the nearer the bottom of the image, the 
closer the object being scanned will be to the robot’s end effector. However, how 
does this system provide quantitative information that will permit the robot to 
acquire the object? 

To answer this question, consider the calibration chart (derived from simple 
8€ometric considerations) shown in Figure 6.9.8. Observe that the top and right 
axes are calibrated in pixels whereas the bottom and left axes are calibrated in 
centimeters representing the x and y distances between the camera and object 
respectively. For example, if the camera viewed the horizontal line shown in 
Figure 6.9.9 extending from pixel element (32,64) to element (96,64), the object 
Producing this line would be located about 13 centimeters from the gripper and be 
about 10 centimeters in width. 

The information contained in Figure 6.9.8 is actually stored in the vision 
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Figure 6.9.9. Calibration chart with example line segment (image) from (32, 64) 
to (96, 64) shown. With permission of the National Institute of Science and 
Technology (formerly National Bureau of Standards). 


of the corners of the workspace. The table is then scanned (by firing the 
strobe unit) in a plane that is approximately parallel to its surface. The 
illuminated object appears in the image as a series of line segments. See, 
for example, Figure 6.9.7. Generally, this step in the process yields coarse 
range information. 


2. The estimate obtained from step 1 is then used to move the robot’s arm closer 
to the object. The flash unit is again fired and more accurate range infor- 
mation is obtained (recall that the resolution improves as the camera comes 
closer to the object because we are now operating in a higher resolution part 
of the calibration chart). 

3. Based on the better range estimate obtained in step 2, the arm is moved 
above (or in front of) the object. The strobe is triggered a third time and 
the system makes fine positional and orientational corrections. The robot 
can then be commanded to grasp the object. 
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In the earlier versions of the system, there was a perceptible pause at ear 
of the illumination points. A later version eliminated this delay thereby Producip, 
an extremely smooth motion. In addition, the processing speed was 
that it was actually possible for the system to track a moving object. 

It should be noted that the NBS system is fundamentally quite different from 
other machine vision devices because it is not “looking” all the time. Conse. 
quently, it is much more time efficient since only three picture SCENES Need to be 
processed (i.e., for the line segment information) during an object ACQuisition 
sequence. 

Besides ranging and orientation data, it is possble to extract information On 
the structure of the object. This is also illustrated in Figure 6.9.7 . For example. 
it is observed that an object with a raised portion of its surface will produce three 
disconnected horizontal line segments. ‘This happens because the segment asso- 
ciated with the elevated section will be lower than the other two. In a similar 
manner, objects with depressed surfaces can be detected by the nature and number 
of disconnected line segments. The figure also indicates that obliquely viewed 
objects produce line segments that are connected but have different Slopes (i.e., 
there is a cusp at their intersection). In addition, it can be shown that objects 
with cylindrical surfaces will produce curved line segments when illuminated by a 
plane of light. 

Besides speed, another advantage of the NBS System Over others is that the 
contrast problem is eased, or even eliminated, by the use of stroboscopic illumi- 
nation. Even if the surface of the object is rather dull, it is possible to compensate 
for the “threshold” problem by increasing the flash duration under computer con- 
trol. With the system used by NBS, the strobe time can be as short as 6.4 us and 
as long as 1.6 ms. (This range is divided into 256 values.) The ambient light 
problem is solved by frame-to-frame differencing whereby data in the flash frame 
is compared with that from a nonflash frame at the same location. This does, 
however, require a ‘‘frame buffer” and hence additional memory. 

At each step in the illumination process, a one-pass line following algorithm 
that looks for corners and gaps is utilized. For each image scan line produced’, 
the system calculates (in hardware) a run length of 8-bits and an intensity of 8- 
bits. (Note that gray-level information is utilized here unlike the GM system 
described in the previous section.) Based on this information, the possible run 
length of the next scan line is predicted (from the slope and curvature information 
of the “working” line). If the actual run length (RL) is within a specified ¢, the 
point is added to the working line and the next run length is predicted. If, however, 
the RL > ge, there are three cases: 


NOW So ranig 


1. RL = 128 which implies that a gap exists. The system will then begin [0 
compute the gap width. 


* In practice, the camera is made to read by columns first (bottom to top) thereby yielding rid 
128 data points/read. Once the system senses a line (Or a point on the line), it reads an appropn4 
row. 
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2. e < RL <I (specified) which implies that the previous point corresponds to 


a corner (i.€., a cusp). The previous line has therefore ended and it is 
necessary to start a new one that has a different slope 


3. RL > I which implies that there is a 


; “depth discontinuity.” ill 
terminate the previous P ty.”’” The system w 


line and compute the discontinuity. 


If no line segments are detected or many faint segments are observed (based 
on the intensity information), the flash can be repeated at a higher intensity. On 
the other hand, if there is too much brightness in the image, which results in 
smearing, the flash intensity can be lowered. It should be clear that this adjustment 
in illumination intensity can be handled easily by the computer. 

Although modified somewhat (e.g., the computer systems have undergone 
considerable change), the NBS vision system is still being utilized at the National 
Bureau of Standards in its automated machine Shop project. At this time, however, 
it has not yet been commercialized. 

Now that the reader has a good feel for two robotic vision systems and can 
see some of the similarities and differences between them, we next consider the 


one developed at SRI which is today being utilized by at least one commercial 
organization. 


6.9.5.3 SRI industrial vision system [1] 


A third robotic vision system was the one developed in the 1970s by SRI and 
had three objectives: 


e Classification of objects 
e Materials and/or parts handling by a robot 
e Visual inspection of parts 


In addition, these objectives were to be done for parts moving on a conveyor belt. 
In the following sections, we describe four different aspects of the system 
that permit these objectives to be realized. They are: 


e Lighting and imaging techniques 
e Imaging hardware 

e Feature extraction 

e Automated parts recognition 


Lighting and Imaging Techniques 


It has been found that images that clearly show features of interest (e.g., 
holes), result in faster and easier image processing. To implement this ‘“‘rule,”’ 
the SRI system works only with binary images so that the pixels contain either 
black or white information. In addition, special lighting is utilized so that it is 
Possible to employ simple thresholding techniques that can clearly indicate the 
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relevant features of an object. This so-called image contrast enhancement jg ach; 

in three different ways. “Ved 


Contrasting Backgrounds. The first way to improve the contrast bet 
the part and the background is to paint the conveyor belt with a req fluore tthe 
When the belt is illuminated with an ultraviolet light source, any nonfluores 
object appears dark against a white background. Note that another Method = 
improving contrast is to utilize backlighting. One way to accomplish this j i 
place the object on a translucent plate and then view it from above. Althou Ay 
Is especially useful for hole detection, obviously such a technique is not applica ‘ 
to the case of a conveyor belt. : 


Color Filters. Another technique that can be used to enhance the image ; 
to mount a color filter in front of the camera lens. Clearly, this is only ate 
when the colors of either the object, the background, or both are known. In 
particular, when such a technique is combined with the fluorescent system men- 
tioned above, a red filter (matched to the spectral response of the fluorescent belt) 
further enhances the image. 


Special Lighting Arrangement. By illuminating an object in different ways, 
it is possible to control shadows and highlights. For example, directional lighting 
can be used to enhance shadows whereas multidirectional lighting can be employed 
to reduce them. Highlights (or reflections from shiny surfaces) can be enhanced 
by placing the illuminating source near the camera. Conversely, oblique lighting 
tends to reduce such highlights. Such techniques are generally referred to as 
structured lighting and are an important component of the SRI System. 


Imaging Hardware 


As mentioned above, the SRI Vision System is primarily aimed at applications 
involving parts that are being transported on a moving conveyor belt. Based on 
what was stated previously, the belt is painted with a red fluorescent and a red 
filter is placed over the camera lens. In addition, the belt is illuminated with an 
ultraviolet source. ‘Thus the contrast between the background and any part is 
increased thereby improving the identification process. 

Although it is possible to utilize a standard vidicon camera to acquire the 
binary image of the part on the conveyor, this is not done in the SRI system. The 
reason for this is that although, at the time of the experiments, it was possible to 
employ a high speed A/D converter to quantize the TV image to a raster of 120 
x 120 points with 32 possible gray levels (i.e., 5-bits of brightness), the relatively 
large amount of memory (i.e., over 14K) needed to store the entire image being 
scanned by the camera made this fairly impractical*. Therefore, a linear array 





pose much 
of having 
ss thereby 


* The reader should understand that with memory so inexpensive now, this would not 
of a problem. Also, it is important to note that storing the entire image has the advantage 
it available for processing at any time. Thus features can be extracted anywhere in the proce 
permitting considerable flexibility in the image recognition algorithms. 
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camera consisting of 128 light sensitive diodes was used instead. With this device, 
one line of data, consisting of 128 one-bit Samples was obtained each time the 
conveyor belt moved 0.05 inches. (Note the Similarity between this approach and 
the one used in the GM Consight System.) During the time that the belt is moving 
to the next location, the raw data are processed (i.e., compressed) by converting 
it into run-length format (only 8-bits of information are needed since this is a binary 
system). At this point, the actual recognition process can be initiated. 


Feature Extraction 


To determine or recognize the part on the conveyor that is being scanned by 
the diode array camera, it is necessary to extract (compute) a set of features that 
permit the recognition to be performed. Before this can be done, however, it 1s 
necessary to obtain the outline of the object. In the SRI system, a connectivity 
analyzer is used to examine overlaps between lines in successive rows of the image, 
which in turn, permits connected components to be ascertained. In addition, holes 
located within the boundaries of the object are also found in this manner. In both 
cases, Standard edge detection algorithms are utilized. 


Once the part outline is determined, the initial or simple features are obtained. 
In the SRI system, these include: 


e Area (the first and second moments are used) 

e CG—Center of Gravity (area) 

e Axis of the least moment of inertia 

e Perimeter length (obtained from the list of perimeter points found by the 
connectivity analyzer) 

e Extent of the object determined by the smallest enclosing rectangle 

e Center of the extent (i.e., the extent rectangle’s center) 


With the above features now available, other features can then be determined. 
For example, the SRI system computes a radius function. 
on the perimeter of the object, the square of the distance 
center of gravity (or extent) is found. Then, the maximum, 
radii become the features of interest. 

Localizing features can also be used to determine the angular orientation of 
the object being viewed. They also permit attention to be directed to a specific 
Portion of the part’s outline. For this purpose, one can utilize: 


That is, for each point 
from that point to the 
minimum, and average 


e The maximum and mini 


mum radius as determined in the manner described 
above 


* Corners or notches (in relation to the maximum or minimum radius function) 
® Holes 


In the case of the water pump shown in Figure 6.9.10, the angle AOB between 
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Figure 6.9.10. Binary image of a water 
pump showing the hole B and the long- 
est radius OA. 


OA, the longest radius vector and OB, the vector formed from the CG to the 
nearest hole B, permits measurement of the position of the movable pump handle. 

In the actual experiments conducted by SRI, there were 200 lines required 
to delineate the pump and with a PDP 11-40, image processing took about one 
second. It should be clear that with the faster computers now available, this time 


could probably be reduced by quite a bit. 


Automatic Part Recognition 


One of the goals of the SRI Vision System is to be able to permit a robot to 
locate and acquire parts that are moving on a conveyor belt. Besides having 4 
complete dictionary of features for each of the ‘“‘world”’ of objects that are to be 
distinguished, there are also other factors that affect the ability such a vision system 


has to reliably recognize an object”*. 
For any vision system, the designer must also take into account that variation 


in an image of a class of patterns are due to some or all of the following: 


e Object rotation 
e Object translation 
e Lighting variations 





; “s st. 
* One refers to a system that can reliably Operate under a wide range of conditions 4s robu 
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e Camera noise 
e Quantization errors 


Rotation and translation problems can be minimized by measuring (and using) 
features that are theoretically independent of those features. For example, area, 
total area of all holes located within the boundaries of the object, and the various 
radius statistics fall into this category. 


For the remaining variations above, the SRI System makes certain important 
assumptions concerning the statistics of the features obtained for various objects 
being viewed. For example, it is assumed that the variance of these features 
depends almost entirely on measurement errors. That is, this statistical quantity 
is class (i.e., object) independent. While such an assumption is not 100% correct, 
acceptable results are obtained. On the other hand, the system also makes the 
assumption that the class conditional (i.e., the object dependent) distribution of 
any given feature is normal. This too is only approximately correct but once again 
yields acceptable results. In addition to the above assumptions, the system nor- 
malizes each feature’s probability density by the standard deviation (SD) (i.e., it 
divides by the SD) thereby permitting a wide range of objects to be handled. 

In actual implementation, a sequential recognition process is employed whereby 
a binary decision tree approach is utilized. Before generating such a tree, several 


off-line operations must be performed. Thus for each object included in the “‘world” 
of objects to be recognized, we must: 


e Measure the distribution of N previously agreed upon features X,, X5, 
Xv ; 


e Compute (J), the mean value of the i™ feature X; for the j'® class (object). 
See Figure 6.9.11. 


e For each feature X;, determine a decision threshold- in the middle of the 


gap that separates all the objects into two distinct groups (i.e., those with 
mean values above the threshold and those below it). With respect to Figure 
6.9.11, it is seen that for the particular single feature X;, the five objects being 
considered (i.e., classes C1 through CS) are divided into two groups (C1, C2, 
C3) and (C4,C5). Thus if the actual (i.e., measured) value of this feature 
for an unknown part is such that it is less than $ the part is probably either 
C1, C2, or C3. On the other hand, if the feature is greater than ¢ then the 
part is most likely either C4 or C5. 


Rank the N features by values of the largest gaps. It should be clear that 
the larger the gap, the more reliable the binary subdivisions will be and hence 
the object recognition. 


In the actual detection scheme, select for measurement the feature for which 
the largest gap is a maximum. 


Once the operations above are performed, the decision tree can be constructed 
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Class C2 Class C3 Class C1 Class C5 Class C4 


w(2) — y(3) (1) @ p»(5) (4) x, 


Figure 6.9.11. The Gaussian shaped distributions labeled Class Cl through C5 
show the statistical distributions of the ith feature (e.g., perimeter) for a set of 
five objects. 6 is the threshold that separates sets of classes. 


and the actual detection process can be initiated. As an example, we consider a 
“world” of seven objects that are to be recognized consisting of four automobile 
parts (castings). Note that three of these have two stable configurations, e.g., a 
cylinder head (referred to in Figure 6.9.12 as Head 1 and Head 2), a piston sleeve 
(Sleeve 1 and Sleeve 2), and finally a disk brake caliper (Caliper 1 and Caliper 2). 
The connecting rod (Conrod) shown in the figure only has one stable state. Thus 


Connecting Rod 
(Conrod) 


Cylinder Head 
(On Side) 
[Head 1] 


Cylinder Head 
(Upright) 
[Head 2] 


Piston Sleeve 
(Upright) 
[Sleeve 1] 


Piston Sleeve 
(On Side) 
[Sleeve 2] 


Brake Caliper 
(Lying on Side) 
[Caliper 2] 


Brake Caliper 
(Lying Flat) 
[Caliper 1] 





Figure 6.9.12. Seven outlines of foundry Castings 
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as far as the system 1s concerned, there are seven possible objects to identify. 
Moreover, for this example, the following seven features are used: 


e X, = Perimeter of the figure 


e X, = Square root of the area 
e X;, = Total hole area 

e X, = Minimum radius 

e X, = Maximum radius 

e X, = Average radius 

e X, = Compactness = X,/X, 





Caliper 


1 
No <> Sleeve 
1 


Sleeve Figure 6.9.13. Binary decision tree for 
2 Caliper . a 
the seven images shown in Fig. 6.9.12. 
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Utilizing these features and based on the results of the “‘off-line’’ measure- 
ments described above, the decision tree for the seven objects results. As shown 
in Figure 6.9.13, the tree indicates that once the image of the object being vieweq 
is stored in run length format, the system should first find X; (the total hole area) 
followed by X, (the minimum radius) and so on. It is interesting to note that for 
this rather small number of objects, only four of the features must be computed 
to accurately determine which object ison the conveyor. In fact, in the experiments 
conducted at SRI, an average of 2.7 features were required and recognition was 
accomplished in less than 1 second. As might be expected, most of the errors 
were found to be produced by poor binary images. 

Although the SRI Vision System was developed over ten years ago, it is still 
being used in somewhat modified and expanded form by Automatix, Inc. under 
the trade name AUTOVISION™*. 


6.10 SUMMARY 


This chapter illustrated many of the major aspects of machine vision, especially as 
applied to robots. The concepts presented permit the general understanding of 
the components, hardware, software, and algorithms that are often required in a 
vision Or remote sensing application. 

The reader should understand that the techniques presented here, while use- 
ful, will very often need to be modified before practical implementation is achieved. 
These modifications may be in the nature of using selected regions of interest, 
using computational approximations that provide for efficient implementation, or 
other similar techniques that permit the transfer of the theoretical or academic 
techniques into the real world of engineering and manufacturing implementation. 
Furthermore, the techniques presented in this chapter should be used as “‘vectors” 
that will point the implementer toward a good direction but will not give all the 
details required. For example, one may choose a horizontal edge operator for 
enhancing edges, but one also has to select the coarseness of the operator as well. 
The algorithm itself may be obtained from the literature, but the specific imple- 
mentation parameters must be selected by the user. 

Another issue of interest is the fact that the same problem may be solved in 
more than one way, and the method for selection of the most appropriate method 
will not be found in any textbook. The authors have sought to present many of 
the important techniques, and must regrettably leave the selection of the appro- 
priate technique in any given environment to the user. The example in Chapter 
Nine serves to illustrate some of the problems associated with vision systems in 
robotics. 





* For example, Automatix has developed and incorporated a special-purpose language called 
“RAIL,” which permits the vision system to be more readily interfaced to the robot. In addition, 
modern 32-bit microprocessors have been utilized, which allow both binary and gray-level data to be 
processed. 
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6.1 a. Assume that an image has been digitized in x and y by increments of Xp and Yo. 
To reconstruct the original continuous image, what is the maximum spatial band- 
width that the original image must have had? 

b. What size scanning aperture would be necessary to prevent aliasing of the digital 
image in Part A with x, and y, as defined previously? 


6.2 Assume that you have available a RAM of size 16,384 8-bit bytes. Organize a storage 
allocation map for this RAM so that you can store image representations from 32 x 
32 to 1024 x 1024 pixels. Discuss and describe in detail the specific size of the pixel 
maps, with regard to x and y and gray level. 


6.3 Draw a graph representing the general input-output relationship of linear contrast 
enhancement. Assume that an 8-bit gray-scale representation is to be used to encode 
each pixel. Draw graphs showing the transfer relationships for image inversion and 
image binarization. 

6.4 For the data shown in Figure 6.5.7, design a generalized direct coding data structure, 
assuming that the intensity values are to be binarized at a threshold value of 106. 
Assume that the binary values from the direct coded binary data structure are to be 
redefined into a packed data structure, whereby each 8-bit word will now hold 8 pixels. 
Generate this new data structure and show an example. 

6.5 Explain why the DDC method would not be useful for binary images. 

6.6 Using square grid paper, construct a binary image of an ordinary object by taking a 
photograph from a magazine of an automobile, a wrench, or some other “blob’’-type 
object. Construct the binary image by tracing the object on the graph paper and then 
marking each “pixel” that is covered by your object. Using the algorithm described 
in Section 6.6.2.4 for contour following, generate edge contours for the object by 
starting at the center of the leftmost boundary of your graph paper. Repeat this 
process by starting at the right-hand border, at the top, and at the bottom. Are all 
four contours identical? If not, explain why. If they are identical, explain the out- 
come. Are the edge contours always going to be identical for a general binary image? 
Explain what would happen if the object that you chose to binarize is placed at random 
locations (both translationally and rotationally) on your graph paper. 

6.7 a. Find a coffee mug and compose drawings of all different stable states. Two states 
of the same object are said to be different if a simple rotation or translation of the. 
object cannot reduce their graphic descriptions to congruency. 

b. Consider a ‘master drawing” that is available for the coffee cup. How would you 
use this master drawing as a “‘template”’ for comparison of all new unknown cases? 

ce. Construct a flowchart or structured program to compare the master drawing to an 
unknown test case. Make certain that you have included a specification of the 
problem before you give the solution. 

d. Assuming that you have available a 256 X 256 digital rendition of the master drawing 
and the test case, use the procedure you have detailed from Part C to estimate the 
number of computations required to identify the test object, and estimate the 
amount of computer time required if the calculations were to be done on an ordinary 


6 


mini- or microcomputer. 
6.8 a. Using the drawings you have constructed for Problem 6.7, derive a set of descriptors 


for the coffee cup. 
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b. Research the set of rotationally and translationally invariant moments given in [9], 


Section 7.2.2. Compute these moments for the coffee cup. | 
c. Draw a flowchart or compose 4 structured program for using this reduced dimen- 
sionality feature set for learning an object and then for categorizing an unknown 


object. 
6.9 a. If each pixel in an image is modifi 
Iyew(t, Y) = 4 U(x, y) + 
tistical correlation coefficient (see Section 


ed by a linear change in brightness, i.e., 


show (mathematically) that the Fisher sta 


6.6.3.3) is unaffected by this transformation. | — 
b. Repeat part (a) if the model M is affected by a different gain a’ and offset b’ [i.e., 


Myew(x,y) =a’ M(x, y)+ 5] 7 | 
c. Show that the Fisher statistical correlation coefficient does not change if both model 
and image are modified by a different gain and offset value simultaneously. 


6.10 Makea10 x 10 x 4 image consisting of a central square 6 X 6 pixels in size which 
all have a gray-level value of 15. The pixels surrounding the inner box should be 


filled in somewhat randomly with gray levels 0 through 14. 
a. Define an Edge Template/model for the top, bottom, left, and right edges of your 


image. For example a left-edge template could be 
000111 


000111 


Now search for each edge of your image by using the Fisher statistical correlation 
method. 
b. Define a template for each corner, for example 
00 0 
0 11 (top left corner model) 
011 


and use the Fisher statistical correlation method to find each corner. 
6.11 For the image defined in Problem 6.10, find the edges by: 
. Sobel operator | 
, Contrast operator 
c. All first difference one-dimensional operator. 
Compare the results obtained for each of the operators above and comment on the 
characteristics of each process. 


sa & 
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Computer Considerations 
for Robotic Systems 


7.0 OBJECTIVES 


The purpose of this chapter is to provide an understanding of the computer ar- 
chitecture of robotic systems. The reader will gain an appreciation of the practical 
considerations that comprise the selection of a computer system from both the 
hardware and software point of view. 

The topics to be treated in this chapter are: 


Architectural considerations (operating Systems, multitasking, distributed 
processing, multiprocessors, bus structures, robotic considerations) 


e Role of computational elements in robotic applications (communication func- 
tionality, calculation functionality, coordination functionality) 


e Real-time processes (event-driven processes, sensor information processing) 
e Robot programming languages 

e Robot programming methods 

e Artificial intelligence 
& 
& 


Path planning 
Robot’s computer system 


7.1 MOTIVATION 


putational elements in robotic systems Is essential, 


The use of computers and com 
just as the presence of the brain in an intelligent animal is essential. In this chapt¢ 


| 
| 
| 
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Sec. 7.2 
we present broad but by no means totally comprehensive coverage of some of the 
nore important relevant topics. The material is intended as an introduction to 


the major topics of importance, and readers are advised to use other detailed 
rextbooks and industry articles to round out their background. 

One usually thinks of a computer as a device used for computation. In fact, 
webster’s New World Dictionary defines a computer as “an electronic machine 
that performs rapid complex calculations or compiles or correlates data.”’ This 
simple concept 1s woefully inadequate when dealing with robotic systems, since 
many of the uses of computational elements are for tasks other than traditional 
computing. In particular, when one considers that most robotic manipulators 
utilize numerous microprocessors, the computational concept traditionally defined 
no longer spans the complete usage of computer components in a robotic system. 
In many cases, the microprocessors are much more “control” elements rather than 
“computational’’ elements. 

Elsewhere in the controller, the computer components may be used for com- 
municating to both the outside world and among other components in the robot 
controller. Additionally, a computer may be linked to a display unit (e.g., a color 
graphics display or CRT terminal) that is used to program the robot or to monitor 
its activities. 

The more traditional computer tasks of language translation into instructions 
usable by the robot controller and path planning* are also performed by the com- 
puters in the robot controller. 


1.2 ARCHITECTURAL CONSIDERATIONS 


As will become evident, computers have a variety of roles to play in robotic systems. 
The efficient use of computational elements relies heavily on the use of more-or- 
less standardized or “off-the-shelf” devices, with custom units being kept to a 
minimum. The benefits of flexible automation through robotics can best be achieved 
by using standard programmable elements available from a wide variety of vendors 
and suppliers, reserving the custom engineering and task-specific activities for those 
tasks that require them. For example, a peripheral interface adapter (PIA) is a 
s€neral-purpose programmable interface device that may be configured in hundreds 
of ways under software control. If one were to hardwire such a function every 
time it is needed, the cost of such interface units would be prohibitive. The 
availability of these programmable devices brings the unit cost of robotic flexible 
‘utomation within reason. Other examples of such devices are stepper motor 
“Ontrollers and communications protocol interface devices. 


OTR 


info “Path Planning is a method whereby the path or trajectory of the end effector is computed from 
_ en about its current position, where it is supposed to go, how it is supposed to get there (e.g., 
“raight line), its speed, and other criteria defined by either the user or external sensors. 
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A descriptive discussion of operating systems, multitasking, distributeq Pro. 
cessing, multiprocessors, bus structures, and robotic considerations will be Dre. 
sented in this section. 


7.2.1 Operating Systems 


A computer operating system handles most of the details of management of file, 
resources, program utilities, peripheral devices, communications among software qe. 
velopers, debugging, and documentation tools, such as code change tracking ang 
automatic backup file creation. Even in the most inexpensive personal computers, 
an operating system removes much of the menial drudgery of software development. 
so that the programmer can be dedicated to developing the application software 
Without operating systems managing the computer resources available, there is no 
question that almost no software would ever be developed. _ The point here is that 
the operating system makes it possible to develop software, since it manages the low. 
level details far better than any human being could ever hope to do. 

Prior to the existence of operating systems, the human programmer was 
required to keep track of where programs were physically located (e.g., which bin 
of paper tape), which versions were the most recent, what changes were recently 
made, and so on. The operating system has improved the efficiency of software 
development and has permitted less skilled programmers to develop useful soft- 
ware. 

Several standard computer operating systems have evolved and been devel- 
oped recently. Two of these are listed below, with some of their attributes. 


MSDOS: developed for the IBM family of personal computers and compatible 
products; provides a development and execution environment for a single 
user; provides the support and availability of numerous languages, compilers, 
assemblers; provides numerous utilities for file manipulation, directory ma 
nipulation, networking. 


UNIX: initially developed by AT&T primarily for use within its corporate 
structure, it was soon made available for a wide variety of computing envi 
ronments from very large computer systems to very small microcomputels. 
The system supports single- and multiuser environments with a very Wide 
range of system utilities, languages, and communications support. UNIX 
has been adapted to execute on a very large number of different compute! 
manufactured by many companies. It also provides facilities for transporting 
software among many different computer environments. Generally, UNI 


is not suited to real-time applications, but there are variants, so-called real: 
time UNIX, that are suitable for real-time operation. 


Operating systems provide the “hooks” 


ag for both and program: 
ming languages to simplify the laborious task o programmers Pp 


f program development. With these 
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nooks, programmers do not have to be intimately familiar with the details of the 
hardware. For example, by utilizing a standard interface to an output device (such 
as a printer), the programmer may print messages and data by using a link to a 
subroutine that takes care of all device-dependent peculiarities, so that the problem 
and not the mechanics of printing may be focused on. 

Using a commercially available operating system in a robot controller, one 
can speed up the development process and reduce the learning curve of potential 
users, since features such as file management, batch file generation, and on-line 
debugging tools are available. 

Initially, since special microprocessor architectures were designed for use with 
each particular application, it was difficult to introduce the neophyte to the ad- 
vantages of robotic technology. Recently, robots that utilize personal computers 
as their master controllers have become commercially available. These systems 
facilitate the implementation of the robot in the industrial or educational environ- 
ment, since the time required for learning may be greatly reduced due to the general 
familiarity with the personal computer operating system and hardware. An ex- 
ample of this type of robot is the RTX, a SCARA-type robot arm. This robot 
can be interfaced directly with an IBM PC/XT or compatible. Installation is simple, 
requiring only a cable connection from an RS232-C port of the PC to the control 
port of the robot. ‘‘Programming” of the robot is equally simple since it may be 
manually driven using the cursor control keys as a teach pendant, or it may be 
programmed through software using standard programming languages. A library 
interface exists for the high-level language, PASCAL. 

There are other proprietary operating systems available, too numerous to 
list, but in their own environments have many, if not more than the features 
discussed above. 


7.2.2 Multitasking 


Multitasking is an attribute of operating systems that permits the execution and man- 
agement of several (many) processes in the same time frame. This does not mean 
that the programs are executing at the same time, since a single CPU (central processing 
unit) or MPU (microcomputer processing unit) can be performing only one instruction 
at a given time. Multitasking permits numerous users each to be executing several 
programs at the same time transparently to the other users, and each program operates 
transparently to the other programs. Since only a single CPU is present, multitasking 
will slow the execution speed of any single program, although this may or may not 
be perceptible to the user. For example, if one program is sampling a process through 
an analog-to-digital converter at 100 samples/s, and another program is printing a 
Program listing, there may be no perceptible difference in program execution or 
Performance. If, however, two programs are both using a floating-point processor 
to perform complex calculations, (e.g., as could be required in path planning algo- 
nthms), both programs may be severely affected relative to execution speed. It is 
also possible to permit different programs to have different priorities in such a way 
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that one program’s execution may be compromised (e.g., slowed down), go that 
another may be allocated more processing time. 


Multitasking should not be confused with concurrency, which allows e 


; vax X€cution 
of co-processes that may share information. A multitasking operating System does 
not necessarily allow concurrency, and concurrency does not necessarily allow mul- 
titasking. 


Multitasking-Robotic Considerations. na robot controller, many events can 
occur asynchronously. For example, if the controller is servicing a terminal ip 
order to get commands from the user, it has no way of knowing exactly when a 
key may be depressed or which key may be depressed. To complicate Matters, 
let us assume that besides servicing the keyboard, the controller is waiting for 
signals from each jOint processor to tell it that the joint has reached its desired set 
point. Additionally, the controller must monitor the state of a digital input line 
that informs it if an intruder has entered the workspace and it must be precomputing 
the trajectory for the next move it is required to make. These and a host of Other 
tasks warrant the use of a multitasking operating system to implement parts or all 
of a robot controller. By using a multitasking scheme, the controller can perform 
a certain task such as precomputing the next trajectory at real-time speeds and 
Service other tasks when the appropriate interrupt occurs. For example, each time 
a key is depressed on the terminal, an interrupt may be generated that stops the 
current task, reads the character, places it with any other characters in a buffer, 
and checks for a termination character (such as a line feed). If no line feed occurs, 
the previous task continues; otherwise, a new task is started which interprets the 
command just received and may spawn other tasks to accomplish the directive. 


7.2.3 Distributed Processors 


Most computer systems used in nonrobotic application have a single processor or 
a collection of processors that act, from the user’s perspective, as if there were 
only a single processor. However, in robotic systems, there are often distributed 
processors dedicated to specific tasks. For example, it is often the case that each 
axis will have a dedicated processor, and all of these are then controlled by a single 
master processor. ‘This is done so that each axis can respond quickly enough to 
control (e.g., actuate, sense, and modify) some element outside the computer (€.8-» 
the actuator, gripper, sensor, etc.). 

The use of distributed processors typically permits a simpler program struc 
ture, and more computational power (and therefore controllability) in most ap 
plications. Of course, one of the disadvantages is that information must be passed 
among processors so that their activities can be synchronized. 


7.2.4 Multiprocessors 


Multiprocessors are a special case of distributed processors. Multiprocessors M4y 
be utilized to share computational load for the same task, for providing redundancy 
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in computation, oF for sharing the multiaxis controllability load in a system. For 
example, in space vehicles, multiprocessors execute the same task and the results 
of all the processors are compared in order to maximize safe operation of the 
spacecraft. To understand the redundancy issue, one need only remember space 
launches that were scrubbed because of computers that did not agree. 

Shared processing can be visualized by considering weather prediction com- 
puter systems that would require 24 hours of computer time to predict weather 24 
hours from the present. One might as well wait the 24 hours and walk outside to 
observe the weather instead of waiting 24 hours for the computer results. These 
tasks are so complex that multiprocessors are the only reasonable solution with 
today’s technology to solve the problems. Even with multiprocessors. weather 
prediction is still not real time (or very accurate). 

In robots, to date, such systems have not been utilized. However, it Is 
possible that as the need for higher-performance manipulators and more sophis- 
ticated controls (e.g., optimal and/or adaptive) grows, multiprocessor techniques 
will become more important. 


7.2.5 Bus Structures 


A bus is a vehicle for transportation. In computer parlance, a bus is a vehicle for 
transportation of information. There are a multitude of bus structures that are 
used and have been standardized so that many standard products are availabie. 
Some of the standard buses are: 





Type Originator 
IBM PC bus IBM 
Multibus Intel 
Multibus IT Intel 
VME bus Motorola 
STD bus 
IEEE 488 bus Hewlett-Packard 
Q-bus Digital Equipment Corp. 
Unibus Digital Equipment Corp. 





In addition to these commonly used bus structures, there are proprietary 
buses designed by manufacturers that have not become industry standards but are 
used for a single company’s products. 

Attributes that may be associated with buses are numerous. ‘These include: 


¢ Bus width (i,e., how many lines are on the bus?) 
¢ Functionality (i.e., are the lines handling addresses, data, control, or power?) 
© Speed (i.e., what bandwidth of signal transmission is permitted?) 
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® Multiplexing (i.c., do all lines have the same function all the time, or do 


ie) | | A ee they 
have different functions depending on cycle location or periodicity?) 


® Purpose (i.c., do the lines have specific cyclic functions, or are they pro 
grammabic 7?) | 


e User adaptability (i.c., may the user define certain lines differently and per. 
manently for different applications?) 


In addition to these attributes. there are physical and mechanical issues, such 
as size of the bus, the type of connector, the electro-magnetic radiation properties. 
ruggedness, ability to withstand shock vibration, thermal shock, radiation, and $0 
on. The variety of considerations is too large to cover fully in this text. but jt 
should be understood that the issue of bus structure is as dynamic as the evolution 
of computer architecture itself, and the lifetime of a bus structure affects choices 
of components as well as basic system design considerations. 

Currently, there are no standardized bus structures for robots, for this reason 
it is virtually impossible to interface one manufacturer's hardware with another, 
This should be contrasted to modern computer manufacturing where interface 
standards exist and are used to interconnect different vendors’ hardware and soft- 
ware. The lack of a standard has hampered the growth of the robotics industry. 
Standards have been proposed by the SME and the IEEE, which if adopted, will 
begin to rectify the situation. 


7.3 HARDWARE CONSIDERATIONS 


Virtually every robot manufactured today has at least one computer within it. The 
simplest robot relies on the ability to control data flow and formats (protocols) to 
some degree and therefore has some sort of logical processing unit. This is gen- 
erally considered to be a computer, and when so integrated may be a special- 
purpose hardware computational or control device. Nevertheless, it is still con- 
sidered a computer, even though it may have no programmable features. Despite 
the fact that a computer was used to implement the functions required, its pro- 
gramming remains essentially fixed and consequently cannot be changed. Al 
though certain options for its operation may be selected by the user by setting some 
switches or from a terminal, the sequences of operations remain as the designet 
originally chose them. The flexibility will not be compromised, however, within the 
design envelope, as One can program a computer to perform complex calculations 
even though the programmer cannot change the basic set of machine instructions. 
More powerful robots must have the ability to perform coordinate transfor 
mations and/or straight-line coordinated motions. As a consequence, the com 
putational tasks become significant and the computational power required increase 
correspondingly. Also, as sensor inputs and real-time signal processing are T°" 
quired of the robot in the future, the computational burden will increase even MOF 
drastically and the addition of more computational elements may well become 
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expensive. In this instance, special-purpose hardware may become cost-effective 
in handling the external interface problems. Ata certain level of complexity, there 
becomes no other way to solve the problems, except by designing special-purpose 
hardware with built-in sophisticated functionality. This is especially true for high- 
speed operations such as are encountered in assembly operations. An example is 
the use of special-purpose arithmetic-logic units (ALUs) customized for machine 
yision applications. The problem of parts alignment is often handled by the use 
of binary correlation. This is a process that is time consuming and requires several 
nested loops of high order. Performing these using computer language instruc- 
tions, even with very fast 32-bit microprocessors still requires at least a second for 
parts having a moderate area. A specialized ALU may require only a few hundred 
milliseconds and may cost only a few thousand dollars. 


7.4 COMPUTATIONAL ELEMENTS IN ROBOTIC APPLICATIONS 


The use of computational elements in robotics covers a very broad spectrum of 
applications, including classical computational roles such as complex calculations, 
operating system and language functions, procedure definitions, and so on. In 
addition to these classical roles, computers are also used to control the actual joint 
servos and interface with external sensors to coordinate communications among 
elements, interface with factory host computers, and coordinate workcell activities. 
In the following few paragraphs, some of these roles will be detailed and will serve 
to illustrate the multifaceted role of these computational elements. 

Figure 2.2.2 showed the details of a model of a robot controller. Recall that 
the controller’s purpose was to provide the intelligence to cause the manipulator 
to perform in the manner described by its trainer. To accomplish this functionality, 
seven subsystems were defined (see Section 2.2), each with a specific task that 
taken together could provide relatively complicated robot control. 

It is important to note that computational elements play an extensive part in 
the implementation of these subsystems of a robotic controller. Additionally, one 
should note that there may be many possible implementations for the controller. 
Factors such as cost, available technology, and required functionality and designer's 
choice contribute to the final architecture. 

The following sections describe some of the roles of computational compo- 
nents as related to robotic control. The reader is encouraged to correlate the 
concepts presented in these sections with the general system overview of a robotic 
controller as presented in Sections 2.2 and 2.4 in order to gain an understanding 


of the internal functions of the controller. 


7.4.1 Control Functionality 


The simplest role of the computational element in a robotic application is that of 
a Simple digital control unit, for example, activating or deactivating electrome- 
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chanical relays or electrical switching elements (such as a transistor) in Order to 
turn motors on or off with a so-called ‘“‘bang-bang” strategy. The use Of the 
computational element in this form is similar to a traffic light controller, w 
simple activation or deactivation of specific valid pathways for data or mec 
activation systems is effected. 

Slightly more complex roles for control elements may be envisioned as pro- 
grammable algorithm-level controllers for use in driving servos or displays. For; 
example, a digital-to-analog (D/A) converter is used to convert a multibit signal 
in the internal domain to an analog, or continuous signal, in the external world. 
The result of a computational algorithm for control may result in a desired drive 
signal of 3.7 V. In the internal computer world, this signal will have a multibit 
representation in a unitless, abstract sense. Conversion of this unitless number to 
a measurable quantity is achieved through the use of the D/A converter. This 
Output signal could, therefore, be used to drive controllers to illuminate a lamp to 
a certain intensity or to modulate an alarm sensor with a variable “‘chirp” signal 
(a “‘chirp”’ is a fixed amplitude, increasing frequency signal) or in fact may be used 
to produce a special output signal for communication between the computer and 
a human being. An important point to be made in conceptualizing computers as 
control elements is that these are rather nonstandard, nonclassical applications of 
computational devices. 

Although all these examples clearly require computational elements to create 
the necessary signals, the output of this information through control actuators is 
often overlooked as a major functional role of computational elements. 

Computational elements may also be used to interrupt sensor data and to 
plan and control actuation functions: for example, the use of analog-to-digital (A/D) 
converters to sense the environment or to sense conditions in the external world 
and to format those properly so that a computational program may then massage 
those data for appropriate external manipulation. Using these components as 
input (A/D) and output (D/A) devices creates the scenario whereby closed-loop 
control of actuation systems may be achieved. 

Often, the individual joints of a servo-controlled robot are controlled by 
individual microprocessors. ‘These are sometimes called slave or joint processors, 
and perform a number of control tasks, including acting as a digital summing 
junction which compares the set point from the master processor with the actual 
position data obtained from the encoder or other position sensor (see Chapter 4 
and Appendix C). Other functions performed include linear interpolation of the 
set points to produce smoother joint motion, and finally implementation of a variety 
of digital computation schemes, including, for example, a PID controller. 


her eby 
hanica] 


7.4.2 Communication Functionality 


Another role of computational elements is to provide communication (i.e-, ©* 
change of information between and among components). The controlled exchange 
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of information permits processes to proceed according to the designer’s plans, even 
though the processes may be asynchronous, random, or concurrent. 

In a crude sense, the control components represent communication between 
the internal quantized computer world and the external world. They communicate 
in the sense that information is passed between these two environments. In a 
more general sense, however, there are no secure, formal mechanisms for guar- 
anteeing data validity between the computer and its input/output devices. For 
example, if an A/D converter is used, the computer receives a number when it 
queries the device. However, the computer has no knowledge of the utility of the 
signal, or its validity. 

The next higher level of complexity is that of a secure communication pro- 
cedure, a so-called protocol by which elements communicate. This is perhaps best 
illustrated by the telephone as a communication element. It is clear that the 
telephone is used to pass information between at least two system elements. How- 
ever, without the use of protocol, telephone communication would have much less 
information content. This need for protocol is illustrated by the following example. 
Imagine the difficulties a listener would encounter if a caller started to speak 
whatever thoughts or phrases came to mind without first identifying himself or 
herself. At an even lower level, one can imagine picking up the phone handset, 
punching in a number, and speaking without even waiting for the call to be an- 
swered. The point of this absurd example is to indicate the importance of protocol 
that permits confirmation and verification that the recipient of the information is 
prepared to receive it and that the packaging of the information is correct. 

These concepts have been formalized in great detail, and standards have evolved 
for a variety of these so-called protocols. The following section will introduce some 
of the basic concepts but will not delve into great detail with regard to a standard 
definition of communication. Several national committees and organizations, such 
as the American National Standards Institute (ANSI), American Society of Mechanical 
Engineers (ASME), Electronic Industries Association (EIA), Institute of Electrical 
and Electronics Engineers (IEEE), National Electric Manufacturers Association 
(NEMA), Robotics International of the Society of Manufacturing Engineers (RI/SME) 
and the Semiconductor Equipment and Materials Institute (SEMI) have generally 
cooperated to define certain standards on these issues. 

One of the simpler forms of communication between computers is a binary 
input/output (I/O). In a primitive sense, binary I/O is simply the passage of bit- 
organized information (i.e., a string of bits each able to take on a value of 0 or 1, 
true or false, on or off). The interpretation of the status of these bits resides with 
the user, and generally there is no security in this type of communication. This 
is the type of controlled communication scheme discussed in Section 7.4.1. It 
relies on other devices or elements to be ready and prepared to accept or deliver 
data when requested, in a so-called ‘asynchronous mode. Asynchrony in this 
discussion implies that each element has the ability to arbitrarily (in time) assert 
its data. 
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ACK 


Figure 7.4.1. ACK/NACK Pairing of 


REQ states. 


It is obvious that without a proper communication protocol, asynchronous 
data transfer can create havoc with the information flow. A simple mechanism 
to overcome the potential difficulties associated with asynchronous data transmis- 
sion is known as handshaking. The simplest form of handshaking requires the 
dedication of two binary lines (ACK/REQ) in a so-called ACK/NACK pairing of 
states. This is illustrated in Figure 7.4.1. Using two such data lines to request 
and/or acknowledge readiness from a device requires careful selection of valid 
states for either the transmitter or receiver to occupy. These states are shown in 
Figure 7.4.2, whereby device A is requesting the attention of device B. Generally, 
2 bits are required to guarantee absolute security of state preparedness on the part 
of two potentially independent processes. 

The use of these bits is similar in principle to a flag system on a rural mailbox. 
In this situation, if the postal patron requests a pickup from an RFD mailbox, the 
patron will raise the red flag on the box. The mail carrier will observe the red 
flag, stop the vehicle, remove the material, and drop the flag. Confusion can, of 
course, result from this simple system if the same red flag is used to inform the 
postal patron that the mail carrier has deposited mail in the RFD box. Therefore, 
more than simple intelligence is required to understand the meaning of the red 
flag, and generally the context of the situation dictates its interpretation. 

For example, on rural mail routes, the carrier typically arrives in a prescribed 
time window during a 24-hour time period. If the red flag is still raised after that 
typical time period, either the carrier was unable to keep to a regular schedule, or 


ACK =b’ 





State Sequence 
4 5 


Figure 7.4.2. Example of secure hanc- 
shaking. The columns in the table ind 
cate the system state. The numbers | 

through 8 represent the state sequence: 
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in fact the outgoing mail was picked up and mail deposited in the box at the same 
time. Clearly, the use of a red and blue flag in a so-called ACK/NACK paired 
scheme would eliminate this confusion (as is illustrated in Figure 7.4.2) since the 
carrier would raise the blue flag if mail was deposited, and would drop the red flag 
to indicate that the mail carrier had been there. 

This type of handshaking is simple and secure, but also requires a great deal 
of overhead, since every communication must utilize the concept of flags. Tech- 
niques for exchanging information packets reduces some of this overhead, at the 
expense of not guaranteeing that every bit of information is sent and/or received 
only when the receiver/transmitter is certain to be ready. Packeted information 
transfer allows for error checking on a relatively infrequent basis and detects certain 
types of errors in transmission so that at the very least, errors can be logged and 
appropriate action taken. Such action may be a request for retransmission, or the 
data could even be ignored. 

Figure 7.4.3 illustrates the packeting of information using a simple scheme 
to transmit a message of N bytes of information. This is known by many different 
terms, but the SECS1 (Semiconductor Equipment Communication Standard) pro- 
tocol designates this technique as the ‘‘Data Link Protocol.”” The idea is simple 
in that first, the receiver is informed as to the length of the message (i.e., how 
many bytes will be transmitted). This is then followed by the message itself, and 
finally, a quantity called the checksum is transmitted. With such a format, the 
integrity of the message is preserved and errors in transmission detected. 

Clearly, the key to the protocol is the checksum (which is also known as 
longitudinal redundancy check, or LRC). Normally, the checksum is the negative 
of the sum of the binary-coded numeric values of the message and is usually 
truncated to one or two bytes. As long as the structure of the message is known 
by the receiver, an error in transmission can be detected by computing a local 
checksum and then comparing it to the transmitted value. This technique will 
detect the occurrence of single-byte transmission errors. 

It is important to understand that it is possible, although unlikely, to have 
multiple byte errors that will still produce the same checksum. If one wants to 
prevent this situation from occurring, more complicated error-checking techniques 
must be used, such as CRC (cyclic redundancy checks) that can detect multiple- 
byte errors. However, these require the evaluation of polynomial error formulas 
(as compared to the simple linear sum of the LRC) and are more time consuming. 
Moreover, it is usually not found to be necessary for most applications, except 
where there is the distinct possibility of noise-corrupted transmission. 

In robotics applications, communication between slave and master processors 
would probably use LRCs to ensure accurate information up and down the infor- 
mation chain. In this respect, robotic communications parallels other multi-pro- 
cessing applications, requiring secure communications and needs no extraordinary 


techniques for implementation. 
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7.4.3 Calculation Functionality 


In addition to the roles just described, more classical calculation roles may be 
attributed or assigned to computer components in a robotics system. One is that 
of performing a variety of coordinate transformations as will be developed math- 
ematically in Chapter 8. Such transformations are necessary to develop drive 
signals for the control portions of the robot. For example, moving a gripper or 
manipulator from one point to another typically starts with specification of motion 
in a rectilinear or Cartesian coordinate system. However, to achieve the desired 
motion, these coordinates must be transformed into the specific joint space of the 
robot (e.g., Cartesian, cylindrical, spherical). 

Usually, these transformations are mathematically complicated and require 
transcendental function evaluations. Consequently, some type of relatively so- 
phisticated mathematical processing is required. This can be accomplished in a 
number of ways, including the use of software routines, hardware evaluation uti- 
lizing a floating-point processor, or employing software lookup tables. In a robot, 
the decision as to which technique to use is tied to the final system cost, speed, 
implementation, expandability, and generality. 

Another major area where classical computer calculation-type functions are 
involved in a robot is in signal processing, e.g., noise removal from a distorted 
signal is a common requirement in sensor data analysis. Signal processing may 
be accomplished in both the analog and the digital worlds, and may be multidi- 
mensional. That is, there may be multiple lines of data coming in from the outside 
world in the form of binary input/output or in the form of analog or continuous 
signal input and output. An example of this is the processing of an ultrasonic 
acoustic signal from the outside world to determine position information, or perhaps 
to monitor acoustic emissions from a variety of electromechanical components such 
as motors, gears, and so on. In addition, metal surfaces scraping against other 
metal surfaces may produce acoustic emissions that are detectable and may be 
useful to the robot controller for preventative maintenance scheduling. 

Another example of complex computational needs is in the field of vision, 
whereby one may be inspecting an outside world environment relative to the robot 
for the purpose of alignment: for example, in palletizing objects, alignment of 
integrated circuit chips or in the alignment of surface-mount components on printed 
circuit boards. These tasks are relatively computationally heavy and will generally 
require a dedicated processor for implementing these functions tin a timely and 
efficient manner. For example, one may need to direct the robot to position a 
Camera so that it may ‘‘see”’ the environment. This information may then be 
Passed to a vision processor which calculates the alignment offsets, passes that 
information over to the robot perhaps through a controller, and then to the trans- 
formational pathways or internal routines of the robotic computer. This permits 
the information to be translated into specific velocity and acceleration control 


Signals. 
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Another possibility for using a vision system to augment the robot’s senge of 
the environment would be to accept or reject parts, or to characterize ory grade 
them. An example of this might be in a microchip dicing system, whereby one re 
inspecting a matrix of semiconductor components on a diced wafer. These Wafers 
are often marked with ink dots to indicate rejection, and the robot may simply 
pick and place the good components into acceptance bins or packages. The poorer; 
quality components or those that have been rejected may be either left on the 
wafer carrier or may, in fact, be taken off the carrier and deposited into a reject 
bin. A refined classification of this application would permit multiple ink dots o; 
multiple coding of the surface of the chip so that one might grade parts into a 
variety of different categories. In this manner, one could fabricate variable quality 
assemblies by inspection, ranging from those with the highest down to those with 
the lowest. 

In addition to the vision and coordinate transformation tasks, calculation is 
required in the area of direct axis (or joint) control. For example, if one is using 
a servomotor to drive a robotic axis, there are a variety of ways to accomplish this 
task. As discussed in Chapter 4, a digital-to-analog (D/A) converter could be used 
to drive the servo amplifier directly. In general, the calculation of the required 
drive signal is not trivial, and in fact the output will usually have to be shaped 
rather precisely in order to produce the desired robot performance (i.e., smooth, 
vibration-free motion). The so-called ‘‘on/off’” or “‘bang-bang”’ control systems, 
whereby the input to a servomotor is a step of a known value, is a relatively 
straightforward control procedure. However, step signals, as explained in Chap- 
ters 3 and 4, will introduce high values of derivatives of position, velocity, and 
acceleration creating untoward effects in the output (e.g., excessive mechanical 
vibration). ‘The obvious need to profile motions throughout space and to control 
axes simultaneously makes the problems associated with axis control computa- 
tionally intensive. 

In addition to the direct output requirements, position and/or velocity feed- 
back information must be acquired and utilized. The acquisition of real-time 
information may be computer resource intensive, since some of those signals may 
have to be filtered digitally. Additionally, making use of the feedback signals to 
compute new positions, velocities, and accelerations may also present a large com- 
putational burden. Although not currently done, in the not too distant future 
external sensory data will be fed back to the master processor and will be used to 
modify the set points sent out to the joint processors. In effect, the system will 
then be recomputing the axis transformations to produce the desired manipulator 
motions. The role of the computer in this environment is therefore more or !ess 
traditional. Appendix C shows the computational algorithms necessary to accom 
plish these tasks. 

Additional computational complexity is introduced by requiring coordinated 
motion control whereby all of the robot’s joints must start and stop at the same 
time. A further level of computational difficulty results when the required motion 
must be in a Straight line in three-dimensional space. There will invariably be 
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velocity constraints, or there may be the requirement to use “‘via’’ (by-way-Of) 
oints whereby the robot must move through these “‘via” points to provide the 
desired path. 

All of the examples above are computationally substantial tasks that may 
require floating-point processing, matrix calculations, and transcendental function 
evaluations, and as such serve to demonstrate the need for a powerful set of 
processors for robot control and implementation. 


7.4.4 Coordination Functionality 


There are other examples of nontraditional use of a computer element in a robot. 
For example, the control and coordination of multiple robots used to execute the 
same tasks, possibly with other material-handling equipment, is an important ap- 
plication. As discussed in Chapter 2, the concept of the coordination requires a 
cell controller to control the entire operation. This device must be able to co- 
ordinate the robotic manipulators, all sensory systems, as well as other maternial- 
handling systems, and of course must be able to keep track of the work in process 
and the location of individual completed subassemblies. The cell controller may 
also be required to report all of this to a factory host computer, which can interrupt 
or modify the plan of the specific cell controller. 

The cell controller may either be located within the robot’s controller or else 
may be a separate entity. For simple applications, the robot controller may per- 
form the functions of the cell controller. However, in more complicated situations 
a separate unit may be required. The robot may not be aware that a cell controller 
is being used, but instead may just be following a preprogrammed path which is 
activated or deactivated remotely. In other situations, complex communication 
protocols between the cell controller and the robot may be required. This is 
especially true when multiple manipulators are being used. 

As suggested earlier, the cell controller may be nothing more than a micro- 
processor with very simple processing capabilities, or may be a complicated mini- 
computer controlling a variety of components. One good example would be in a 
hybrid circuit manufacturing facility, where parts may be shuttled in wafer form 
mounted on sticky-tape frames (frames with a film and an adhesive surface) or 
Waffle packs (plastic carriers with indented pockets for holding individual inte- 
grated-circuit dice in their own receptacles). These parts may then need to be 
assembled onto a small (roughly 2 in. x 2 in.) ceramic substrate which will have 
chips bonded to them (either glued or soldered). Wires must be attached internally 
nr the substrate and the chips. Full testing of the chips may be required, 
ieee en they may be graded and placed into bins. This application requires a 
a Y complicated cell controller with use of common protocol with common lan- 

ai throughout the system (See Figure 7.4.4.). 
eleme " addition to these types of coordination, the robot computer or computing 
i ae S may need to communicate with CAD, CAM, or CAE data bases. That 
may have designed and simulated a specific assembly process on a host 
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Figure 7.4.4. Schematic of a hybrid circuit assembly system that utilizes a robotic manip- 


ulator. The system utilizes a common protocol and language and requires a complicated cell 
controller. 


computer. This assembly program may have been download 
computers, including the cell controller, for example, which may then be required 
to direct the assembly operation, including all the robotic manipulators so that the 
product is assembled. Note that in this case the robots were never taught directly, 
but obtained their “programs” electronically. Although this is not yet a widespread 


practice with robotic systems, it is one area in which to expect developments to be 
made. 


In addition to the roles of the computers described 
of coordinated path planning for the robot motions. 
might require that the work be moved in a prescribe 
set of workstations. This might require the integra 
manipulators, perhaps incorporating information fr 
from other sensors. 

As an example, we may look at the 
requires the stringing of wires 
pattern in space. Normally, 


ed to a variety of 


above, there is the concept 
For example, path planning 
d manner through a specific 
tion of a number of robotic 
OM a vision system as well as 


: Production of a wiring harness, which 
of various lengths throughout a specific geometric 


wires will have to be routed around pins located on 
the harness board, Thus one must coordinate the Stringing of a specific wire based 


on previous ones that the robot has installed. Furthermore, the work that the 
robot has completed may not be stable after installation. For example, when 
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stringing a wire, there may be a curl or misposition of the wire after the robot 
releases the end of the wire. Then, when the robot goes back to place the next 
one, it must have some way to guarantee or to measure the placement of these 
previously laid wires so that the harness is produced in a reliable fashion. 


15 REAL-TIME CONSIDERATIONS 


In this section we discuss two important topics of real time event-driven processes 
and sensor information handling. The concept of “‘real time” is best thought of 
as “needed now.”’ This needed-now concept gives the idea of urgency to the topics 
in this section, since either type of processing is so time-critical that if either process 
cannot be served as soon as possible, the robot and its environment may subse- 
quently be uncontrollable, probably with catastrophic consequences (e.g., the robot 
may become unstable). 


7.5.1 Event-Driven Processes 


In many software applications, a computer must respond to input from the “outside 
world.’ Two methods of achieving this are: 


e Program driven 
e Event driven 


Program-driven response implies that the input occurrence is expected in some 
sense. Entry from a keyboard is usually of this type, whereby a program is waiting 
for an input via a keystroke. Although the program does not know what the 
response will be, it does know that if there is a response, it will occur at a specific 
location in the program. Another example of such a response is that caused by 
a switch closing, indicating that a robotic gripper has successfully acquired a part. 
Here, the robot is expecting the closure of the. gripper at a specific point in its 
Program sequence. This is similar to a program waiting for an input of data prior 
to executing a calculation. 

The above should be contrasted to an event-driven process, where the timing 
of the response as well as the type may be totally unpredictable. As an example, 
consider a pedestrian walking up to a busy street that has a pushbutton-activated 
Street light. If the button is pushed, the traffic light controller will respond in time 
by changing the light to a yellow-then-red condition for traffic, and eventually to 
green for the pedestrian. If the pedestrian never pushes the button, the light will 
never change, and the internal ‘“‘brain”’ will perform its normal tasks, keeping the 
light green for traffic, checking whether all the lamps are functional (by checking 
Current through the filaments), and calling the traffic department to replace a bulb 
if necessary, 
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A similar event-driven response would be required if someone enters the 
workspace of the robot. If instrumented properly, the work envelope can be 
monitored by ultrasonic sensors, photo-optical interrupters, or pressure mats that 
will interrupt the robot’s controller, and stop the robot motion activity so that the 
intruder will not be struck and possibly injured by the manipulator arm. 

This concept of responding to random external events 1s not only useful for 
protecting an intruder or a pedestrian, but is a feature that all robotic computers 
must have in order to control and interact with their environment. The contro] 
of motors for coordinated motion, the coordination of assembling parts from various 
feeders,. and an endless variety of robotic assembly tasks require the ability to 
respond to random events, because not all robotic sequences are deterministic by 
nature. Even though the specific global actions desired may be deterministic, the 
specific joint actuation sequences may be random, due to external perturbations 
from unknown or variable loads and/or because parts may arrive at pickup points 
randomly. The robot controller must be capable of properly handling these situations. 

The response to the external events may be required in as short a period as 
several microseconds, so the computer’s architecture must be such that this is 
possible. In some instances, where operating system overhead must be contended 
with, an interrupt latency may be experienced. Interrupt latency is the time from 
when the external interrupt occurred to the time when the interrupt is serviced or 
handled by a software interrupt service routine. If this latency becomes too long, 
it may be necessary to bypass or disable the operating system temporarily or 
permanently, and compose special software so that the interrupt may be handled 
in real time (i.e., rapidly enough so that the event requiring attention is handled 
in an appropriate and timely fashion). In virtually all modern-day computers, the 
ability to respond to interrupts is present, as is the ability to prioritize, queue up, 
and process hundreds or thousands of these interrupt requests. 

In many parts of the robot, it is important for certain events to occur at known 
times. For example, in the digital control of a motor, it is extremely important 
for the position sensors (the encoders) to be sampled at a uniform rate (e.g., every 
0.5 ms). The control signal must then be output to a D/A converter (DAC) at 
the same rate. To accomplish this, a real-time clock that generates a signal every 
0.5 ms can be used to trigger an interrupt line. When the interrupt occurs, the 
sensor is sampled and the computations necessary to generate the control signal 
are performed. The control signal is transferred to the DAC at a known time 
after the input was sampled and the sequence repeats. 

Other uses of real-time clocks are to generate time and date stamps and to 
time events. Also, in many applications, it is necessary to inhibit a robot from 
moving to the next taught point until mechanical settling occurs. This can be 
achieved by delaying the operation using an accurate timing program. 

Very often, the operating system is able to assist in managing event-driven 
requests by providing utilities to service these requests, and by providing software 
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fools to assist in the development of appropriate software (e.g., interrupt service 
routines). 


7.5.2 Sensor Information Processing 


Consider what happens if object acquisition is attempted without an external sensor. 
In other words, there are no sensory mechanisms required or available to confirm 
target location or that the robot has properly grasped an object. If it can be 
guaranteed that the object can be positioned within the tolerance of the pickup 
mechanism, acquisition can be achieved. However, when an object’s position is 
not absolutely predictable, one must have some type of sensing mechanism. A 
variety of sensory devices that can be utilized in this respect have already been 
described in Chapters 5 and 6. In the case of vision-based sensors, computational 
requirements are very severe. In general, these high-rate external sensors must 
provide integral data compression so that the signals delivered to the robot are 
low-rate and the robot controller will not be overwhelmed by massive data handling 
requirements. For example, the vision-based sensor should reduce the imagery 
from the order of megabits to a few bits (e.g., the centroid location of the object 
to be grasped). 

The important thing to understand, however, is that these tasks require com- 
plex sensory information processing and tend to be computationally large. For 
example, if one uses a moderate bandwidth sensor of only 50 to 100 Hz and attempts 
to use a high-speed, off-the-shelf processor to perform signal processing, it is readily 
discovered that the computer rapidly runs out of computing power. This means 
that very frequently, special-purpose hardware processors must be developed in 
order to handle the incoming data rates, or data must be simplified immensely so 
that the computer can make relatively simple decisions. 


ee a ee ee ee 
EXAMPLE 7.5.1 
To illustrate the ideas above, consider a simple filtering operation for noise 
reduction. The following equation represents a simple single-pole low-pass 
filter: 


G(n) = AG(n — 1) + (1 — A)F(n) 


where F(n) = input sequence from an A/D converter 
G(n) = output sequence 
A = filter weight (0 =A = 1) 
If A = 0, the input will pass directly to the output, and thus the filter will 


behave as an all-pass device. As A approaches unity, the filter properties 
will approach those of an ideal integrator. For intermediate values of A, 


low-pass filter characteristics result. 
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Now assume that the following times are valid for a hypothetica] 
speed microprocessor (e.g., a Motorola 68000 with a 12.5-M clock rate 
€). 


data conversion = 10.0 ps 
add time = 1.0 us 
6.0 ws 


memory access = (0.5 ps 


multiply 


Assuming that A and 1 — A are precomputed and stored in memory, then 
for each new computation, one data conversion, five memory accesses two 
multiplies, and one add will be required to filter the data. This corresponds 
to 25.5 ws or a data rate of 39,215 Hz. Assuming a 10 input sensor base 
One can process these data at a rate of less than 4,000 Hz Per sensor. Furthey 
assuming a 5-sample/cycle sampling rate, one can handle signals with fre- 
quency content up to 784 Hz with this high-speed processor.* It should be 
noted that slower rate processors would be at least proportionally poorer in 
performance. For example, a Motorola 6800 operating at 1 MHz would be 
approximately 12.5 times slower, which would yield a per sensor date rate of 
about 62 Hz. This 62-Hz rate may well be marginal in high speed applications, 
especially when other interfering processes, such as linear distortions, exist 
which require digital control system compensation. 


Other types of sensory considerations have to do with nominal versus ex- 
traordinary conditions. This requires the ability to plan for exceptions to normal 
circumstances. For example, the robot manipulator may be programmed to g0 
through a variety of movements. However, if an extraordinary situation occurs 
(e.g., the gripper is empty when it was not Supposed to be), the robot must have 
some plan to handle this deviation from normal behavior. For example, where 
the part has not been properly acquired, the robot must then have the ability either 
to reacquire it or to inform its controller to execute an emergency stop sequence. 

To accomplish the above, we may have a force sensor that produces a rather 
simple binary signal that indicates to the robot that either “Yes, the nominal 
condition is present and although there may be variations, nothing out of a 
ordinary has occurred” or ‘‘No, the contrapositive.”’ Without this planning as 
use of even simple sensors, it is obvious that the exceptions to normal behavie 
that often occur will not be taken care of properly. i 

Exception handling is application-dependent and is usually left to the ei 
cation programmer. The action to be taken is highly dependent on the nature 





t 
: ) i . mple 4 
* The theoretical sampling rate is two samples per cycle, but in practice one needs to S@ Pp 
least five times per cycle. 
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the application, and what may be acceptable in one circumstance may be unac- 
eptable in another. 

A robot language is usually the medium by which exception handling is ac- 
complished. For example, once the application is programmed, a subroutine can 
be added to test for the part being present once the gripper has been commanded 
to close. If the part 1s missing, the action dictated by the subroutine (signal for 
an operator, retry, continue without the part, etc.) can be carried out. 

There are also some errors that are sensed by the system in all cases. For 
example, if the manipulator is commanded to move, a check could be made to 
ensure that the motion is occurring (e.g., by monitoring the error signals in each 
of the joint servos). If no motion occurs, it is possible that the robot arm has 
collided with another object or that one or more of the error signals may have 
exceeded a predetermined band. In the event that this type of error is detected, 
the arm could be stopped and the servo gains reduced so that the arm becomes 
“mushy.” (This procedure prevents possible damage to motors and mechanical 
components of the robot.) It is also possible to monitor the control signal for each 
servo when the arm is not moving. In the event that this signal is too large, one 
may be able to conclude that the payload is too big and take appropriate action. 

In addition to these considerations, there is the concept of self-adaptation to 
the environment. For instance, many robots are designed so that they may respond 
to a variety of inertial loads. For example, different payload weights should not 
affect the path that a robot takes in general. Often this is accomplished by changing 
servo gains to compensate for variations in the axes loads that would create un- 
desirable deviations from the proper path. This would be equivalent to a young 
child picking up a lightweight toy and moving it from point A to point B in space. 
If however that lightweight toy was filled with lead shot, and the child attempted 
to follow the original path, difficulty might be experienced in overcoming this 
additional inertial load even if more muscle power was employed. ‘That is, the 
child might have only limited ability to compensate. Although the computational 
algorithm might be there in the child’s brain, the ability to handle that level of 
load might not exist. | 

The idea of inertial compensation can be built into the algorithmic control 
processes so that when the weight or inertia of the load changes (within limits), 
the robot may still move the load over the same path if it is instructed to do so. 
This idea of self-adaptation can be mathematically modeled and included in the 
robot’s internal program. 

Another situation that can be detected by proper monitoring of position and/ 
Or current sensors (in each joint) occurs when the robot strikes an object that was 
previously not known to be there. In this instance, there will be an increased 
amount of resistance to the arm’s motion, which resuits in an unusual increase in 
motor current and/or a large position error. It is possible to program the computer 
to sense these conditions and take corrective action, such as stopping the motion 
Or reducing servo gains. For example, if one visualizes a robot picking up the 
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lead-weighted toy and moving the load from A to B, and one puts a chair 
Way, it would be clearly desirable to have the sensory ability to detect that somethin 

out of the ordinary had occurred and take appropriate action. This Self-adaptation, 
concept more or less fits in well with the previous nominal versus extraordinary 
discussion. 

As more external state sensors (see Chapter 5) are employed with robots, 
the information they provide will be used to modify the original program in real 
time. For example, tactile sensors placed on a robotic gripper provide real-time 
data to the robot’s controller, which then commands the gripper’s servo so that 
the right amount of force is generated. 

Sensors placed in robotic grippers are also important when it is Necessary to 
handle objects which have specific stability, rigidity, and orientation requirements, 
There is no reason to expect that one will always have objects of one type, and a 
truly versatile system should be able to handle a variety of shapes and sizes. 

It is clear that as external sensors are more heavily utilized, the information 
provided by them will increase the computational burden placed on the robot's 


computer systems. his has already been demonstrated in Chapter 6, where vision 
systems and the computational considerations were discussed. 


in the 


7.6 ROBOT PROGRAMMING 


As discussed in Chapter 2, the most sophisticated robot control systems have a 
programming capability that allows for elemental decision making, 
needed to coordinate a robot’s actions with ancillary devices and processes (i.e., 
to interface with its environment). Branching is the ability of the software to 
transfer control during program execution to an instruction other than the next 
sequential command. At a specific point in a task cycle, the robot will be pro- 
grammed to anticipate a branching signal—a special electrical Signal sent to the 
controller by a designated internal or external sensor. If such a signal is received, 
the program will follow a predetermined path or function (branching). If no signal 
is received, the program will continue to follow the main path. Thus a robot 
interacting with a group of machine tools will perform a given sequence of oper- 
ations, depending on which steps have been completed. For example, after a raw 
part is loaded onto a press, the program will look for a branching signal. If the 
signal is received, the program will branch to a pause, causing the robot to walt 
while an ancillary machine works on that part. After the machine has completed 
the prescribed work, an external completion signal is sent to the controller by 2 
sensor located on that ancillary machine. Then the robot is directed to take the 


part out of the press and transfer it to another machine. Decision making ©" 
also be used to correct an operational problem. For example, a program may 
have a branch to a taught subprogram for releasing a jammed tool. 

Robot languages provide flexibility to the user in defining the task to b¢ 
performed. Not only do they permit the motion of the task to be defined but they 


a capability 
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also provide the user with the ability to imbue intelligence in the control program. 
In its simplest forms, this intelligence may check binary sensors and change a 
location, or make a simple decision based on sensory information to handle an 
exception. As the capability of the language increases, the intelligence of the 
algorithm controlling the robot in a specific application can also increase. Thus 
corrections based on sensory inputs (such as vision or tactile sensors) are possible 
along with communication with other computers and data bases. 

Historically, the initial applications of robots were relatively simple and ac- 
cordingly, their controllers did not require or provide sophisticated sequence con- 
trol. Typically, the following sequence was all that was needed: 


e Move to a specified location in space 

e Control the state of a gripper 

e Control the state of output lines 

e Provide sequence control based on the state of input lines 


As applications became more complex, and computer technology more advanced, 
techniques were developed to take advantage of the newer computer architectures. 

In the following section, techniques for robot control sequencing will be 
presented from three appropriately more progressive perspectives (fixed instruction 
sequence control, robotic extensions to general purpose programming languages, 
and robot-specific programming languages). This is followed by a summary of 
robot programming languages and two examples illustrating these methods are 
presented. The section concludes with a discussion of how points in space are 
taught or ‘““demonstrated”’ to a robot. 


7.6.1 Robot Control Sequencing 


Robot sequencing can be accomplished in a variety of ways. As discussed in 
Chapter 2, there are certain features of functionality required by a robot control 
System in order to facilitate both the training (programming of the sequence of 
events) and its use with ancillary equipment. To someone familiar with general- 
Purpose programming languages, it is obvious how certain aspects of this func- 
Hionality can be easily provided by a computer language. What may not be as 
obvious is that most of the important functions needed for manipulator control and 
simple interfacing can be implemented by dedicated sequencers. These sequence 
controllers accept commands (possibly given by the setting of switches) and record 
the robot's joint positions. The sequencing of the manipulator is achieved by 
“playing back” the desired states at a later time. In a certain sense, these se- 
quencers also possess the power of programming languages but without all the 
©xplicit commands and data structures associated with a formal programming lan- 
Suage, 

To contrast various “programming” methods, all of which permit the user to 
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define the sequence of operations of a manipulator, three distinct implementations 
will be discussed. Specifically, they are: 


e Fixed Instruction Sequence Control 
e Robotic Extensions of General-Purpose Programming Languages 
e Robot-Specific Programming Languages 


The first is a relatively simple method which makes use of a fixed event sequence 
in each instruction. The second is based on extensions of programming languages 
which add robot-specific functions (or subroutines) to the standard library, or ip 
which robot-specific commands have been added to the structure of the language. 
The third is a language tailored specifically to the programming or training of 
robots. 


7.6.1.1 Fixed instruction sequence control 


In this mode of implementation, the sequence of the robot’s operation is 
defined by means of a “‘teach pendant” which provides the ability to position the 
tool point of the manipulator in space by means of buttons or a joystick. Additional 
controls allow the trainer to define the state of the gripper (open or closed) and 
the state of each of the output lines (on or off) as well as time delays and simple 
branching based on the state of input lines. By saving joint position, and other 
state data, a sequence of events can then be defined. 

To better understand the nature of a fixed instruction sequence controller, 
the implementation used on the Mark I controller from United States Robots will 
be examined. In general, each program step consists of a series of actions. These 
are: 


Check the status of input lines 

Check for a subroutine call 

Perform a robot motion 

Delay a specified time interval 

Set the state of the gripper (open or closed) 
Set the state of output lines 


To understand how this relatively simple structure can provide sufficient 
program control, and for the sake of discussion, let us assume that the controller 
already has a number of programs stored in its memory. A specific program ‘ 
first selected (by number) utilizing a series of thumbwheel switches. To beg! atl 
sequence of actions defined by the program, a “‘start’’ switch is depressed which 
causes the first instruction to be obtained from memory. First, a logical “ANY 
of a subset of the input lines is performed against a “mask” stored in memory: 
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should be understood that the program will wait indefinitely until the specified 
input line(s) are asserted. Next, if the step is a subroutine (another series of 
program steps), then it is executed and the following program step is obtained from 
memory (note that the motion and subsequent steps are not performed in this 
case). If no subroutine call was indicated, then the robot controller causes the 
manipulator to move to a point in space defined by a set of joint variables stored 
in memory. Once this location is reached, the remaining actions (for the current 
program step) are executed. These include waiting a specified delay time, opening 
or closing the gripper, and the final action, which is the setting of the state of the 
output lines to a value defined in the programming sequence. Following this, the 
next program instruction (step) is fetched from memory and decoded as defined 
previously. After all the steps of a particular program are executed, the sequence 
repeats from the first step. That is, the controller keeps executing the program 
indefinitely. 

Due to the nature of the fixed sequence of actions for each program step, it 
may be necessary to program additional steps to properly sequence the manipulator. 
For example, it is necessary to provide a delay to ensure gripper activation prior 
to arm motion. This is due to the fact that it takes a finite time for a gripper to 
reach its final state after its activating mechanism receives its control signal. ‘There- 
fore, the trainer might want to insert a delay (on the order of a few hundred 
milliseconds) prior to the execution of any other manipulator motion. Since the 
action sequences of a program step without a subroutine call are check inputs, 
perform motion, delay, set gripper state, and set output line states, one easily sees 
that it is possible for the next program step to cause a motion (if the input conditions 
are satisfied immediately) before the gripper’s state has stabilized. To accomplish 
a delay prior to the motion of this subsequent step, it is necessary to program an 
additional step in which no motion occurs but which makes use of the delay in the 
sequence of actions. 

While this type of programming may require substantial human activity, it is 
still able to produce the desired results (i.e., sequencing a manipulator through a 
set of motions). The key to both successful and efficient programming of this type 
of controller is knowing the sequence of actions and how to take advantage of 
them. 

As the complexity of the tasks being performed by robots increased, the 
demands for more advanced motion control and decision capability also increased, 
thereby requiring more sophisticated programming methods. In some cases, the 
simple sequencing controls could be expanded by adding more functionality to the 
teach pendant by means of multiple levels and added control switches. Besides 
increasing the complexity of the teach pendant, this approach also increased the 
Programming time and required skill level of the trainer. —— 

An outgrowth of such complex sequence controllers is a “‘menu-driven pro- 
sramming system that permits the training of the robot using a fixed set of functions. 

he menu system differs from the “fiyed instruction’ sequence control in that 
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instructions specific to each function are generated. Unfortunately the use of a 
menu system can be quite awkward and requires a trainer well versed in the concepts 
of computer programming. . | 

One major advantage of a menu system, however, IS that it may be easily 
extended to accommodate new functions and even provide interfaces to external 
sensors such as vision. It should be apparent that this concept can also be extendeq 
to a robot-specific language by adding a terminal interface and the typical language 
functionality such as syntax checking of instructions prior to execution (or during 
compilation). 

Although extensions of fixed instruction sequence control could certainly have 
provided additional capability, they lacked flexible program control and data struc. 


tures. Consequently, another approach was needed. This approach is discussed 
in the next section. 


7.6.1.2 Robotic extensions of general-purpose programming 
languages 


Another step in the evolution of robot programming was the incorporation 
ofalanguage. The use ofa general purpose programming language with extensions 
provides the user with the control and data structures of the language. The robot- 
specific operations are handled by subroutines or functions. Clearly this implies 
that the training of a robot now requires a person well versed in the concepts of 
computer programming. 

Various permutations of this concept are possible, including the use of sub- 
routines as compared to extensions of languages. The extensions to the language 
include robot-specific commands (and possibly new data types) in addition to the 
existing set of commands (and data types) while leaving the general syntax and 
program flow intact. 

An advantage of using an extension of a general-purpose programming lan- 
guage is that the designers can concentrate on the problem at hand, designing a 
robot instead of spending time designing a sequencer, providing editing capabilities, 
and soon. The actual implementation may make use of a compiled or interpreted 
language depending on the nature of the base language chosen to be extended and 
the objectives of the design team. One other advantage in extending a language 
is that more sophisticated cell control can be handled by the robot controller. In 
this case, it now has more power to perform nonrobot input/output and has the 
ability to perform certain man-machine interfaces, €.g., Statistical and error re- 
porting. 


An cxample program for the United States Robots’ MAKER 22 Scara robot 
is illustrated in Table 7.6.3, (This example is treated in detail in Section 7.6.3.) 
It is interesting to note that this is the form used to program most Scara robots 
from Japan. 

This programming method (as compared to the fixed instruction technique) 
makes use Of program control, specifically the FOR-NEXT loop and the STOP 
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statements. One should also observe that there are statements that do not cause 
robot motion and the sequence of events is chosen by the programmer or trainer. 
Thus it is seen that some of the constraints imposed by the fixed event instruction 
are removed. 

As the available technology became more sophisticated and manufacturing 
requirements grew, the limited flexibility of the language extension approach be- 
came obvious. ‘This provided the impetus for the development of robot-specific 
languages. 


7.6.1.3  Robot-specific programming languages 


A major motivating factor that led to the development of robot-specific pro- 
gramming languages was the need to interface the robot’s control system to external 
sensors in order to provide “‘real-time”’ changes to its programmed sequence based 
on sensory information. Other requirements such as computing the locations for 
a palletizing operation based on the geometry of the pallet, or being able to train 
a task on one robot system and perform it on another (with minor manual ad- 
justment of the points) also were an impetus. Additionally, requirements for off- 
line programming, CAD/CAM interfacing, and more meaningful task descriptions 
led to various language developments. 

Table 7.6.2 shows a complete terminal session of a Westinghouse/Unimation 
robot using VAL 1. This example, discussed more fully in Section 7.6.3, shows 
an entire environment for the training of the robot. As shown in the table, the 
program is retrieved from a mass storage device, then listed, and the fixed positions 
defined in the program are displayed. Finally, the program is executed and output, 
indicating the current cycle, is displayed on the terminal. As the listing indicates, 
this language clearly provides more capability for complex robot control than that 
of the fixed instruction sequencer or the extended language examples described 
previously. 

Section 7.6.2 presents various commercial and research robot programming 
languages and a table that compares program control, robot specific mathematics, 
and input/output capability for each language. Once again, it should be noted 
that regardless of the complexity of the programming language, the objective is to 
define a sequence of operations that are needed to obtain successful control of the 
robot. 


7.6.2 Selected Summary of Robot Languages 


Currently, a large number of robot languages are available, although no standards 
for these exist. The more common languages include: 


e AL 
e AML 
e RAIL 
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e RPL 
e VAL 


Brief descriptions of each of these are given below. This summary is adapted from 
a paper by Gruver et al. [9]. 


7.6.2.1 AL 


AL was the second-generation robot programming language produced at the 
Stanford University Artificial Intelligence Laboratory, an early leader in robot 
research. Based on concurrent Pascal, it provided constructs for control of multiple 
arms in cooperative motion. Commercial arms were integrated into the AL system. 
This language has been copied by several research groups around the world. Im- 
plementation required a large mainframe computer, but a stand-alone portable 
version was marketed for industrial applications. It runs on a PDP 11/45 and is 
written almost entirely in OMSI Pascal [9]. In the AL system, programs are 
developed and compiled on a PDP-10. The resulting p-code is downloaded into 
a PDP-11/45, where it is executed at run time. High-level code is written in SAIL 
(Stanford Artificial Intelligence Language). The run-time system is written in 
PALX. The PDP 11/45 has a floating-point processor, no cache memory, a single 
terminal, and 128 kilobytes of RAM memory. Two PUMA 600’s and two Stanford 
Scheinman arms were controlled at the same time by this language. 


7.6.2.2 AML 


A manufacturing language (AML) was designed by IBM to be a well- 
structured, semantically powerful interactive language that would be well adapted 
to robot programming. The central idea was to provide a powerful base lan- 
guage with simple subsets for use by programmers with a wide range of expe- 
rience. An interpreter implements the base language and defines the primitive 
operations, such as the rules for manipulating vectors and other “aggregate” 
objects that are naturally required to describe robot behavior. A major design 
point of the language was that these rules should be as consistent as possible, 
with no special-case exceptions. Such a structure provides a ready growth path 
as programmers and applications grow more sophisticated. AML is being used 
to control the RS/1 assembly robot, a Cartesian arm having linear hydraulic 
motors and active force feedback from the end effector. The computer con- 
troller on the RS/1 assembly robot consists of an IBM series/1 minicomputer 
with a minimum of 192-kilobyte memory, Peripherals include disk and diskette 
drive, matrix printer, and keyboard/display terminals. A subset of AML was 
employed on the Model 7535 robot that was controlled by the IBM personal 
computer. However, the features of this version are not included here since 
the 7535 is no longer being marketed by IBM. 
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7.6.2.3 RAIL 


RAIL was developed by Automatix, Inc. of Bilerica, Massachusetts as a high- 
level language for the control of both vision and manipulation. It is an interpreter, 
loosely based on Pascal. Many constructs have been incorporated into RAIL to 
support inspection and arc-welding systems, which are a major product of Auto- 
matix. The central processor of the RAIL system is a Motorola 68000. Peripherals 
include a terminal and a teach box. RAIL is being supplied with three different 


systems: vision only, no arm; a custom-designed Cartesian arm for assembly tasks; 
and a Hitachi process robot for arc welding. 


7.6.2.4 RPL 


RPL was developed at SRI International to facilitate development, testing, 
and debugging of control algorithms for modest automatic manufacturing systems 
that consist of a few manipulators, sensors, and pieces of auxiliary equipment. It 
was designed for use by people who are not skilled programmers, such as factory 
production engineers or line foremen. RPL may be viewed as LISP cast in a 
FORTRAN -like syntax. 

The SRI Robot Programming System (RPS) consists of a compiler that trans- 
lates RPL programs into interpretable code and an interpreter for that code. RPS 
is written mostly in Carnegie-Mellon’s BLISS-11 and cross-compiles from a DEC 
PDP-10 to a PDP-11 or LSJ-11. The programs written in this language run under 
RT-11 with floppy or hard disks. The RPL language is implemented as subroutine 
calls. The user sets up the subroutine library and documents it for people who 
must write RPL programs. Previously, SRI operated the Unimate 2000A and 
2000B hydraulic arms and the SRI vision module with this language. 


7.6.2.5 VAL 


VAL is a robot programming language and control system originally designed 
for use with Unimation robots. Its stated purpose is to provide the ability to define 
robot tasks easily. The intended user of VAL will typically be the manufacturing 
engineer responsible for implementing the robot in a desired application. 

Eight robot programming languages are compared in Table 7.6.1. Prior 
Programming knowledge is helpful but not essential. VAL has the structure of 
BASIC, with many new command words added for robot programming. It also 
has its own operating system, called the VAL Monitor, which contains the user 
interface, editor, and file manager. The central monitor contains a DEC LSI-11/ 
03, or more recently, the LSI-11/23. In a Puma 550 robot, each of the joints is 
‘ontrolled by a separate 6503 microprocessor. The monitor communicates with 
the user terminal, the floppy disk, the teach box, a discrete I/O module, and an 
Optional vision system. VAL is implemented using the C language and the 6502 
assembly language. It has been released for use with all PUMA robots and with 


TABLE 7.6.1 LANGUAGE-COMPARISON TABLE 
AL AML HELP JARS MCL RAIL RPL vay 


herrea mmm tc ia gee etn EO LT 
Language Modalities 
Textual x x x s m ‘ ‘ ‘. 
Menu x 
Language Type se 
Subroutines = 
Extension ‘ - 
New language x x x 
Geometric Data 
Types 
Frame (pose) x 
Joint angles x 
Vector x x 
Transformation 
Rotation 
Path a 
Control Modes 
Position 
Guarded moves 
Bias force 
Stiffness/compliance 
Visual servoing 
Conveyor tracking x 
Motion Types 
Coordinated joint 
between two points x x x x 
Straight line 
between two points ' x 
Splined through 
several points x x 
Continuous path 
(“tape recorder’”’ 
mode) 
Implicit geometry 
circles 
Implicit geometry 
patterns | x 
Signal Lines 
Binary input 0 64 
Binary output 0 64 242 10 32 
Analog input 64 0 242 0 32 
Analog output 4 0 242 0 64 
Display and Specification of Rigpations 
Rotation matrix 
Angle about a vector x 
Quaternions 
Euler angles : x . x 
Roll-pitch-yaw ~ 
Ability to Control Multiple Arms 
Multiple arms x 
Control Structures 
Statement labels 
If-then 
If-then-else 
While-do 
Do-until 
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E 7.6.1 (Continued) 


AL AML ace 
er 
x 
Case 
For . ’ ; 
Begin-end * | | 
Cobegin-coend . ‘ ; 
procedure/function/ 
subroutine - : . ' 
successful Sensor Interfaces . 
Vision > ; : 
Force - . : ; ; ji : 
Proximity . 
jmit switc . : 
Races Modules ; . . 
Text editor : : | 3 
File system 0 : . : : 
Hot editor : 
Interpreter : ‘ ; 
Compiler . . | 
Simulator ¢ 
MACROs “ 
INCLUDE statement * . 
Command files | 
Logging of sessions ” 
Error logging : 
Help functions . : 
Tutorial dialogue * 
Debugging Features 
Single stepping x x x x 
Breakpoints ’ ' ; | 
Trace : . : 
Dump : : 


a 


Source: Reprinted courtesy of the Society of Manufacturing Engineers. Copyright 1983 from the ROBOTS 
7/13th ISIR Conference Proceedings. 


*Using force-control or limit-switch action. 

Currently being implemented at Jet Propulsion Laboratory. 

“Uses visual inputs to determine set points but does not specifically perform visual servoing. 

“Relies on the VAL controller. 

“Currently being implemented at Stanford University. 

‘Custom for each system. 

SAL displays rotations as a rotation matrix. 

"Normally, JARS does not display these forms; however, the user may write a routine to print them because 
JARS has the forms available internally. 

‘AL accepts directly the specification of an orientation by three Euler angles (or by an angle about a vector). 
‘AL orientations could also be specified by roll—pitch—yaw angles. 

‘Since it is a language based on subroutines added to Pascal, JARS has all the structures of Pascal. 

MCL can invoke tasks in parallel using INPAR. 

"HELP permits the simultaneous activation of several tasks. 

"Reported by the IBM T. J. Watson Research Center, Yorktown Heights, New York; not commercially 


available. 
“JARS and HELP use the systems support features of the RT-11 operating system. 


© Uses the su ing system 
: pport features of the PDP-10 operating sy a | 
“A simulator has been developed at the IBM T. J. Watson Research Center, Yorktown Heights, New York. 
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the Unimate 2000 and 4000 series. The languages described above as well as three 
others, HELP, JARS, and MCL, are compared in Table 7.6.1 and have beep 
adapted from Gruver et al. [9]. 


7.6.3 Sample Programs 


The following examples illustrate the use of two different robot programming 
languages, VAL and one employed on a particular Scara-type manipulator. 


eee 


EXAMPLE 7.6.1 VAL Example 


Assume that it is desired to pick up identical objects from a known 
location and then stack the objects on top of each other to a maximum stacking 
height of four. Figure 7.6.1 shows the application. 

Let us consider this application and its implementation in the VAL 
programming language. Table 7.6.2 is a listing of a session on the terminal, 
which includes loading and listing the program, viewing the value of the stored 
locations, and finally, executing the program. 

The dot (.) in the leftmost column is the prompt, which tells the user 
that VAL is ready to accept acommand. The first command given to the 
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Figure 7.6.1. Workspace for VAL programming example. The pickup and deposit 
points are on the xy-plane offset (in z) from the robot’s origin by —448 mm. 


TABLE 7.6.2. LIST OF A VAL TERMINAL SESSION 


eee SS Se 


PROGRAM STACK 
LOCATIONS 

OK 

LISTP STACK 


PROGRAM STACK 


1. REMARK 
2. REMARK THIS PROGRAM PICKS UP PARTS FROM A FIXED 
3. REMARK LOCATION CALLED PICKUP, THEN DEPOSITS THEM AT A 
4. REMARK LOCATION CALLED B. IT IS ASSUMED THAT 4 PARTS 
5. REMARK ARE TO BE STACKED ON TOP OF ONE ANOTHER. 
6. REMARK 
i. OPENI 
8. SET B = DEPOSIT 
9. SETI COUNT = O. 
10. 10 APPROS PICKUP, 200.00 
11. MOVES PICKUP 
12. CLOSEI 
13. DEPARTS 200.00 
14. APPRO B, 200.00 
15. MOVES B 
16. OPENI 
17. DEPARTS 200.00 
18. SETI COUNT = COUNT + 1 
19. TYPE! COUNT 
20. REMARK COUNT INDICATES THE TOTAL NUMBER OF ITEMS STACKED 
v4 IF COUNT EQ 4 THEN 20 
22. REMARK MOVE THE LOCATION OF B UP BY 75.00 MM. 
23. SHIFT B BY 0.00, 0.00, 75.00 
24. GOTO 10 
25. 20 SPEED 50.00 ALWAYS 
26. READY 
Zi. TYPE «**« END OF STACK PROGRAM ««« 
.END 
.LISTL 
X/JT1 ¥/JT2 Z/JT3 O/JT4 A/JT5 sf 
DEPOSIT — 445.03 130.59 — 448.44 — 87.654 88.890 — 180.000 
PICKUP 163.94 433.84 — 448.38 178.006 88.896 — 180.000 
EXEC STACK 
COUNT = 1. 
COUNT _ 2. 
COUNT - 3. 
COUNT  ~ 


*** END OF STACK PROGRAM ««« 


P 
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robot controller, LOAD STACK, tells the system to recall the program and 
any location data from the disk. The system response is on the next three 
lines, indicating successful completion of this request. The following com- 
mand to the controller is LISTP STACK, which tells VAL to list the program 
which is called STACK. This particular version also delimits the program 
listing by printing PROGRAM STACK at the beginning and .END at the 
end. Two more commands that are used in the table are (1) LISTL, which 
commands the controller to print all the locations that the controller knows 
about (in this case there are two such locations, DEPOSIT and PICKUP), 
and (2) EXEC STACK, which tells the controller to execute the program 
called STACK, which is stored in its memory. Following the EXEC com- 
mand is the output generated by the program STACK. This output is the 
value of the variable COUNT as the program is executed. Note that the 
value of COUNT is used to terminate execution of the program when the 
desired number of items have been stacked. 

Examination of the program listing shows that each line has a number 
associated with it (i.e., 1 through 27). These numbers are used to identify 
a line so that the program may be edited. VAL has an editor that allows 
the user to create programs and store them in the controller. Once stored, 
a program may be modified by referring to its line numbers. The modifi- 
cations include inserting, deleting, or modifying lines. 


The operation of the robot based on the program steps will now be 
described. 


Lines 1 through 6 are comments. 


Line 7 tells the gripper to open immediately and then wait a small amount 
of time to ensure that the action took place. 
Line 8 equates the location of the variable B to a defined location called 


DEPOSIT. This step is necessary since the value of B will be modified 
each time a new item is stacked. 


Line 9 sets an integer variable called COUNT to zero. The variable 
COUNT is used to terminate the program when the proper number of 
items have been stacked (i.e., 4 items). 


e Line 10 has a label (10) associated with it. It commands the robot to 
move from wherever it is along a Straight line to a location 200 mm 
above the point called PICKUP. At the end of the motion, the approach 
vector of the gripper will be pointing downward. Recall that the ap- 
proach vector is defined so that moving along it causes objects to g0 
toward the inside of the gripper. 

Line 11 tells the robot to move its gripper in a straight line toward the 
position defined by PICKUP. In this example, the motion will be along 
the approach vector since the gripper is pointing downward. The po- 
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sition defined by PICKUP is such that when motion ends, the object 
will be inside the gripper’s jaws. 

e Line 12 commands the system to close the gripper and wait a sufficient 
amount of time for the action to occur. In some cases it may be nec- 
essary to add an additional delay if that provided by the command Is 
insufficient. 

e Line 13 tells the manipulator to move along its approach vector in the 
direction opposite from which it originally came to a point 200 mm 
above the pickup point. 

e Line 14 tells the manipulator to move to within 200 mm of point B, 
aligning its approach vector downward. 

e Line 15 commands the manipulator to move in a straight line until its 
tool point is coincident with location B. 

e Line 16 tells the gripper to open so that the part can be deposited. This 
also includes some time delay for the action to occur. As stated pre- 
viously, additional delay may be necessary to compensate for the actual 
valves and mechanics used to implement the gripper and to permit the 
manipulator to settle to the desired location. 

e Line 17 tells the manipulator to move back along the approach vector 
so that it is 200 mm above location B. 

e Lines 18 and 19 increment the variable COUNT and display its value. 

e Line 20 is a comment. 

e Line 21 is a test to see if COUNT is equal to 4. If so, go to the statement 
with label 20; otherwise, go to the next line. 

e Line 22 is a comment. 

e Line 23 modifies the location defined by B so that its z coordinate 1s 
increased by 75.0 mm. 

e Line 24 forces the program to go to label 10. 

e Line 25, which is labeled, tells the controller to reduce the speed of 
motions to 50%. 

e Line 26 tells the controller to move the manipulator to its ready position, 
which is defined as all of the links in a straight line pointing upward. 

e Line 27 tells the controller to print a message to the terminal. 


From the description of the program, one can easily see the power 


implemented by the instructions. Commands exist to cause the manipulator 
to move in a Straight line and to manipulate position data. (Note that the 
“S” in the statement indicates that straight-line motion is desired.) For 
example, the variable B, which represents a location (i.e., a set of six joint 
variables) is modified by a single statement in line 23. Similarly, the com- 
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mands APPROS and DEPARTS are quite interesting because they actual] 
define positions relative to a variable but do not make it necessary for he 
user to define the actual positions for each move that the robot has to aie 
This concept is quite important for robot training, since we have really defineg 
only two positions, PICKUP and B. However, we can move to many po. 
sitions relative to them. Using this approach, if it is necessary to moj 
either of the points (PICKUP or B), the changes made to them will auto- 
matically be reflected in the intermediate points (selectively by the robot’s 
path planner), which are defined solely on these two positions. 


The following example illustrates the programming language used by the 
MAKER 22 (a 4-axis SCARA robot, see Figure 1.3.13) robot from United States 
Robots. The reader should contrast the power of this language with that of Bx. 
ample 7.6.1. 


 ——————————————, 


EXAMPLE 7.6.2 Scara Programming Example 


The MAKER 22 is programmed in a language similar to BASIC, with robot- 
specific extensions. For example, positions in space may be referenced by 
a single-variable name of the form Pxxx, where xxx is a three-digit number 
from 000 to 999. In order that position variables may be referenced by an 
index, it is possible to catenate the P with an integer variable such as A and 
refer to the point PA. Whatever the value (from 000 to 999) specified by 
the programmer, A will then reference the actual position variable. Certain 
operations may be performed on these position points, such as addition and 
subtraction. Additionally, provisions exist to multiply or divide a position 
by a scalar. Only two types of moves are provided in the language: MOV, 
which causes the manipulator to move in a joint-interpolated fashion; and 
CP, which causes the robot to move in a continuous-path fashion. Whenever 
a CP command 1s encountered, the controller will move the manipulator from 
its current location to the point which is the argument of the command while 
also looking ahead for the next CP command and its argument. The occur- 
rence of the next such command tells the controller to continue moving toward 
this next specified position once it has come close to the location defined by 
the previous CP command. This process continues until the end of the 
program or a MOV command is encountered. It is clear that if one wanted 
the manipulator to follow a specific path, all that would be necessary is © 
define a sufficient number of points for the path and then write a program 
that uses CP moves to connect them. 
The example that we explore illustrates the use of topics discussed 10 
the previous paragraphs. It is desired to cause the MAKER 22 to move ! 
a straight line. For our discussion, we will assume that two positions have 
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TABLE 7.6.3 MAKER 22 PROGRAMMING EXAMPLE 
—— 


10: “STRAIGHT LINE” 
N = 10 


i 





a 


Label with a comment 

Number of intermediate points 
plus 1 

Copy Pi to P100 

P101 is distance to be moved 

Incremental distance 


P100 = P1 
P101 = P2 — Py 
P101 = P101/N 


MOV P100 Set manipulator at first point 
Forl = 1TON Beginning of loop 

P100 = P100 + P101 Compute intermediate point 
CP P100 Do CP move to point 

NEXT L End of loop 

STOP 


ee eeeeeeeeeeSSSSSSSSSsSCsisCSCSCSC‘(CSNSCtitCCS 


been defined previously, P1 and P2*, and that we wish to have the manipulator 
move in a straight line starting from P1 and ending at P2. 

Table 7.6.3 shows a listing of the program and comments defining the 
purpose of the instructions. The program in Table 7.6.3 takes the difference 
between the initial and terminal points of the line and divides by the number 
of intermediate points plus 1 to compute an incremental distance. It then 
instructs the manipulator to move to the first point, P100. After attaining 
this position, it computes intermediate points by adding PIOL to PLOU and 
then instructs the robot to move in a continuous-point fashion connecting the 
10 points to form an approximation to a straight line. Note that the last 
point is P2. 

It should be apparent that the robot programming language for the 
MAKER 22 does not contain as high a level of expression as indicated tn the 
example using VAL. This is obvious if one recognizes that a straight line is 
achieved with one instruction using VAL whereas it requires the entire pro- 
gram in Table 7.6.3 to perform the identical maneuver with the Maker 22. 
However, the same functionality, that is, the ability to move in a straight 
line, is provided by both languages. 


a a a ee 


After reviewing these two examples and the discussion on robot programming 
languages, it is suggested that Section 2.4 on the functionality of a robot controller 
be reviewed in order to relate the desired design functionality to this material. 


ee 
*P] and P2 are Cartesian coordinate points in (x, ¥, 2) Space. 
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7.6.4 Demonstration of Points in Space 


To program a servo-controlled robot, a skilled operator often breaks down the 
assigned task into a series of steps so that the manipulator/tool can be directed 
through these steps to complete the task (a program). This program is played 
back (and may be repeated several times, i.e., it can be used as a subroutine) untij 
the task cycle is completed. The robot is then ready to repeat the cycle. The 
robot’s actions may be coordinated with ancillary devices through special sensors 
and/or limit switches. These, in conjunction with the controller, send “‘start work” 
signals to, and receive “completion” signals from other robots or interfacing devices 
with which that robot is interacting. 

A servo-controlled robot can be “taught” to follow a program which, once 
stored in memory, can be replayed, causing the controller to be instructed to send 
power to each joint’s motor, which in turn, initiates motion. This teaching process 
may require that the operator ‘“demonstrate”’ points in space by causing the end 
effector to move (using one of a number of possible methods) to a series of locations 
within the work cell. 

The robot can also be taught its assembly tasks from a CAD/CAM data base. 
Here, the desired points in space are down loaded from such a data base, rather 
than being taught (on the robot) by an operator. This has the advantage of not 
occupying the robot for teaching of points and also permits the optimization of the 
path using simulation techniques. In addition, it is also likely that within the next 
few years artificial intelligence (AI) techniques will permit robot teaching to be 
more generalized. For example, AI will allow the robot to place filled bottles in 
a case or pallet, without having to be explicitly taught a predetermined pattern 
and/or having specific points actually demonstrated by an operator or down loaded 
from a CAD/CAM system. Before discussing this topic, however, we will consider 
more standard techniques of demonstrating points to a robot. 

There are several methods currently in use. The method employed depends 
on the manufacturer’s specifications, control system software, and the robot’s com- 
puting/memory capabilities. Teaching typically involves one of the following meth- 


ods: continuous path, via points, or programmed points. Each of these 1s now 
briefly discussed. 


7.6.4.1 Continuous path (CP) 


With the CP method, the operator releases all joint brakes and enables 4” 
automatic sampler. The manipulator is then manually moved through each of the 
positions required to perform the task. The controller “remembers” or stores the 
coordinates of all the joints for every position. In this manner, complex three 
dimensional paths may easily be followed. Teaching may be done at a SP& 
different from that speed needed for real-time operation (i.e., playback may be 
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at othet speeds, allowing for different cycle times). This method requires 
minimal debugging, allows for continuous-path programming. and requires minimal 
knowledge of robotics. However, a thorough understanding of the assigned task 
is a prerequisite. and editing requires reprogramming from the error point. This 
method 1s typically used with robots employed in spray-painting and are welding 


applications. 


scl 


7.6.4.2 Via points (VP) 


Teaching with the VP method does not require that the operator physically 
move the manipulator; rather, it is remotely controlled by either a computer ter- 
minal or, more commonly, a teach pendant—a device similar to a remote control 
box with the additional capability to record and play back stored commands. The 
teach pendant is plugged into the controlling computer during programming (the 
on-line method), and the operator then presses the appropriate buttons to position 
the arm, with small incremental motion for precise positioning. When the correct 
position 1s achieved, a switch is activated to inform the computer to read and store 
positions for all joints. This process is repeated for every spatial point desired to 
be ‘“taught.”” Essentially, only the endpoints of the motions are demonstrated. 

The VP method is often employed to program discrete points in space (through 
which the end effector is required to pass) and is most commonly used for point- 
to-point robots. The teach pendant is most commonly used for heavy-duty robots 
and in those lightweight robots that have sophisticated control systems. 

There are more advanced systems that allow for the movements and endpoints 
to be recorded in an unspecified order. This enables new programs to be created 
by calling out the points in a sequence that differs from the original order of input, 
thus facilitating programming and editing. These systems also allow the program- 
mer to define velocity and acceleration or deceleration between points. However, 
such advanced systems have an inherent danger; that is, the path resulting from a 
new sequence of movements may inadvertently bring the end effector in contact 
with nearby machinery. For this reason, manufacturers recommend that once the 
program is complete, the program should be played back at a very slow speed to 
minimize the possibility of damage to the robot or other equipment. 


7.6.4.3 Programmed points (PP) 


The PP method is also an on-line system. The robot operates via a prere- 
corded program (i.e., without manual intervention), with the program sequence 
having been set up externally. Applications of the PP method of using decision 
making include orienting (i.e., aligning workpieces in designated positions) for 
assembly operations and material-handling work using conveyers. In addition to 
the techniques used for programming a robot as described above, there is a new 
methodology emerging. This is discussed next. 
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7.6.5 Artificial Intelligence and Robot Programming 


The discipline known as artificial intelligence (AI) is becoming more practical as 
new developments in computer hardware and software evolve. Higher memo 
density, faster processors, and new languages are bringing the tools of artificial 
intelligence to practice. There are “expert systems” development environments 
that execute on nominally priced personal computers, and these are already having 
an impact in many areas previously the exclusive domain of the human thought 
process. Experience is showing that in a complex equipment maintenance milieu 
in certain classes of medical diagnosis, theorem proving, biochemical analysis, and 
a plethora of other fields, AI is contributing to productivity. The much touted 
nationalized Japanese fifth-generation computer project is directed toward creating 
AI techniques that will reduce software production to a blue-collar job. Whether 
or not the Japanese will succeed is yet to be determined, but even if the goal is 
not fully reached, there will be significant technological fallout from the effort. 

In the programming of robotic systems, the use of AI techniques is certain 
to have an impact because of the availability of data base information that can be 
used to plan a robot’s task efficiently. Although there is no integrated system 
available today, laboratory demonstration such as the assembling of simple struc- 
tures from randomly presented and available parts is already accomplished. More- 
over, a number of laboratory facilities are currently implementing Al/expert sys- 
tems in a variety of mobile robots. Intended for use in the nuclear power industry 
and by the military, these devices are being employed as testbeds for practical 
results in the areas of autonomous navigation, collision avoidance, maintenance 
and repair, assembly, reconnaissance, and perimeter monitoring. 


7.7 PATH PLANNING 


Path planning is a critical aspect of robotic manipulator control. Two specific 
aspects of path planning are discussed here. 


7.7.1 Coordinated Motion 


Path planning or trajectory planning algorithms are concerned with the generation 
of the intermediate points along a manipulator’s trajectory. These are the points 
(or positions) that must be fed to the control system so that the joints can be 
commanded to move to the correct locations necessary to position the end effector 
properly. In addition, it is often desired to start and stop all robotic axes at the 
same time. This behavior is referred to as coordinated motion and will modify 
the path-planning algorithm. 

In a robot, the initial path position is inferred (from the current position) 
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while the final path position is specified. Along with the final point, some rule 
defining the trajectory must be specified and may include the following options: 


L. 


8. 


Joints of robot to start and stop at the same time as the end effector moves 
from the initial to the final point (not exceeding physical constraints or robot 


specifications). However, the actual path taken is not specified. This is 
called joint interpolated motion. 


. The “tool point” is to move along a straight line. This is sometimes referred 


to as world motion. Note that this implies that all axes start and stop at the 
same time. 


. The tool (or end effector) is to move along a straight line defined by extending 


the approach, normal, or orientation vectors associated with the tool point. 
This is called tool motion (see Chapter 8 and Section 7.6.4). 

The end effector may be told to follow a straight line as in world motion, 
while the initial and final orientation of the gripper may be required to change. 


. The acceleration or velocity may be specified prior to the motion, or may be 


commanded to change during the motion based on some external input. 


The mathematics to accomplish these types of motion is discussed in Chapter 


It should be apparent that the speed at which the computations need to be 


made must be in “‘real time.’’ This implies that they are completed as soon as (or 
a significant time before) the information is needed by the joint servos. Although 
the mathematics for accomplishing this is formulated in terms of matrices, the 
implementation may take advantage of certain properties or simplifications. That 
is, the actual implementation may involve little or no matrix multiplication. Ad- 
ditionally, and depending on the various types of implementations, it is possible 
that the computations may take too long and certain motions may be impossible 
or speed limited. 


It is also possible to define a series of points that determine the trajectory of 


a manipulator. This can be accomplished in a number of ways, including: 


1. A series of points are taught or demonstrated (defining a complicated curve). 


The manipulator is expected to pass through these points as closely as possible 
and perform some interpolation between them in order to faithfully reproduce 
the path. Of course, the more points taught, the better the curve is repro- 


duced. 


- Three points defining a circle are demonstrated and the manipulator is ex- 


pected to be able to compute any necessary intermediate points so that it can 
draw the circle. 


- An equation is defined (in Cartesian, cylindrical, or other space) that the 


robot is commanded to follow. 
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Various curve-fitting routines or series expansions can be used to implement 
these features. Once again, it is important to note that time is critical and an 
approximation may be needed. For instance, a reasonable trade-off may be made 
on the algorithms used and the actual control resolution and accuracy of the ma- 
nipulator. It may only be necessary to define a joint angle to the nearest minute 
since the resolution of the encoding device may be similarly limited. 

The ideas discussed above need to be implemented in whatever type of pro- 
gramming language is to be used for a manipulator. Some languages previously 
described provide for terse powerful commands. For example, the statement from 
VAL 


MOVES POINT1 


allows the programmer to command the robot to move from its current location 
to one defined as POINT] in a straight line. (The motion will be joint interpolated 
if the ‘‘s’” is deleted.) Other languages may provide the mathematical capability 
to compute intermediate points necessary to move in a straight line but without 
an explicit command. 


7.7.2 Automatic Programming and Worid Modeling 


The concept of automatic programming is associated with a robot “teaching itself.” 
Essentially, the robot is assigned a task and must develop a plan to accomplish it 
autonomously. Various AI techniques are utilized to define the steps that the 
robot must take to accomplish the task. However, before any algorithms are used, 
‘t is first necessary to define a three-dimensional world model. This defines the 
environment in which the robot must perform its designated task. It includes 
models of the pieces or parts that the robot must manipulate as well as any physical 
constraints or obstructions in the workcell. 

The complexity of the modeling process is staggering and compromises must 
be made. For example, if a printed circuit board with 100 holes were modeled, 
one would define the plane and the location of the center of the holes and theif 
sizes. ‘The model probably would not compensate for manufacturing errors such 
as misplaced holes or errors in roundness. Even based on this simple example. it 
can be seen that the model is rarely, if ever, the same as the real world. This 1s 
where the problem begins since the things assumed correct are usually the items 
that will affect the reliability of the process. 

Automatic programming is currently a laboratory tool which is only recently 
being adapted to real-world applications. It also includes the concept of collisio® 
avoidance, in which the robot ensures that it does not hit anything 1n the proces» 
of doing its job. It is expected, however, that as processes become more complex 
and higher performance is desired, future generations of industrial robots will hav’ 
this capability. 
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18 THE ROBOT'S COMPUTER SYSTEM 


As discussed previously in this chapter, the role of the computer in a robot's 
controller can be quite varied. What we will attempt to do in this section is to 
discuss the requirements of a hypothetical robot controller from the computational 
point of view using as a model the generic architecture of a robotic controller, as 
shown in Fig 2.2.2, the capabilities discussed in Section 2.4, and the servo control 
loop discussed in Appendix C. 

Starting from the designer’s and implementer’s points of view, a computer 
architecture similar to Figures 2.2.3 and 4.1.1 is chosen. The use of distributed 


microprocessors to implement the controller has many advantages for the devel- 
opment phase. Specifically: 


e A suitable processor can be chosen for each application, and thereby cost 
and complexity can be kept to a minimum. 


e The software for each processor can be designed, coded, and tested inde- 
pendently of the other processors. 


e The system can be designed to be modular in nature, and the complexity of 
the controller can be reduced when less functionality is needed. 


e If the functionality is distributed in the proper way, the task of troubleshooting 
the final system is reduced to checking only those modules responsible for 
functions that are not operational. 


e If single-board computers with identical computational architecture are used 
to implement some or all of the processors (which in fact actually execute 
completely different software), we obtain commonality of hardware and the 
possibility of swapping cards in the field to facilitate troubleshooting. 


Of course, we must also understand the disadvantages of employing distrib- 
uted microprocessors. These include the following: 


e The communications between the processors must be clearly defined. 


e Provisions must be made so that testing of each processor can be done in- 
dependently of the others. Thus, both hardware and software may be nec- 
essary so as to emulate signals and data from nonexistent pieces of the system. 

e If all the processors must be debugged at the same time, multiple logic ana- 
lyzers or other test equipment must be available. 


| For our hypothetical system, the following additional specification will also 
be included: 


¢ The robot will be programmed using any commercially available language 


and a library of subroutines which perform functions associated with robot 
control. 
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This particular specification makes the system implementation quite simple 
since only subroutines (or functions) associated with robot control have to be 
developed and the remaining control structure of the language, such as loopin . 
data structures, and syntax are already available. To simplify the design further, 
if we choose a commercial operating system that will run in the Processor and 
support the language, we have already accounted for the housekeeping features” 
detailed in Section 2.4 since the operating system should provide for file mainte. 
nance and a commercially available editor can be used to create or edit Programs. 
At this point, the elegant simplicity of our robot controller should be apparent. 

In addition to what has been described above, the remaining pieces that need 
to be included are the specialized interfaces to the electronics that control the 
physical hardware of the manipulator or interface ancillary devices (such as binary 
inputs and outputs). 

The computer we have chosen certainly includes an interface to the outside 
world either in the form of a standard bus (such as VME or STD), serial ports 
such as RS-232C, or a custom interface. In any event, these interfaces become 
the medium of communication between the control program and the hardware- 
specific interfaces. 

Figure 7.8.1 shows the proposed architecture of our robot controller. We 
have assumed that some type of relatively high-speed interface exists between our 
‘“‘central control unit’’ or ‘host’? and each piece of specific hardware. Here the 
term ‘‘central control unit’ or “‘host’”’ is used to encompass the functionality of 
sequencer, memory, and computational unit defined in Chapter 2. 

Note that in this system a separate computer is used to control each servo 
associated with the robot. This processor essentially executes code as defined in 
Table C.4.1 (without the profile generator). Therefore, the only information it 
needs is the set point data, which will come from the host over the ‘‘common bus” 
at a fixed rate. To synchronize the “joint processors,”’ another message is sent 
to all of the processors simultaneously, telling them to execute their algorithms 
using the new set point data. A timing diagram depicting this data transfer iS 
shown in Figure 7.8.2. As pointed out in Appendix C, it may not be possible to 
send set point data to the joints as fast as we would like (e.g., every 1 ms) because 
of the host’s computational limit. In this case it is possible that data are sent every 
16 ms and the joints themselves have a linear interpolator used to generate inter- 
mediate set point information. 

Following the concept of data transfer between the host and joint processor 
just discussed, other processors on the “‘common bus” also need to receive com 
mands and data from the host and send data back to it. The host may use the 
information directly or route it to one of the other processors of the system. In 
keeping with the communication scheme of Figure 7.8.2, these data are transmitte 
to and received from the processors at fixed times. Thus Figure 7.8.2 may be 
modified to include slots for communication to the other computers. While a 
the surface, this type of communication scheme may seem to contradict the ae 
for extremely fast response, the update rates are generally much faster than t 


Operating System 
User 


SY ST ce cts 
——— —<—$ A sie 
— ——- ee 
—_ eS 
——— a iS i nn 


Vision System 


Controls 


© Terminal Application 













Library of 
Robot Specific 
Programs Such as 
Position Training 


Device Drivers 
® Disk 

© Terminal 

® Bus 





High-Level 
Programming 
Language 


Specific Code 






Device Driver for 
Common BUS 


j f 
Library o Communication 


Robot Control 


Storage 
(Disk) 





Functions 





Host or Central Control Unit . 
| 
| 
| 
| 
| 
| 
| 
| 
| 
| 
| 
| 
| 
| 
| 


Common BUS 
Bidirectional High-Speed Communication Link 


ann: ian aaeeennnaiaies | aims” aaa aa Aa 


Joint 
Processor #n 


Joint 
Processor #1 


Device Driver for 
Common BUS 


| 
| 
| 
Device Driver for | 
| Communication 
| 
| 
| 
| 
| 


| | 

|| 

|| 

|| 
Common BUS | | 
Communication | 
|| 

[| 

[| 

| | 

| | 


Device Driver for errs 
PID Linear Binary |/O Modules J 


Algorithm | Interpretor 
1/O Control Program 





n ——_ 
| Joint Processors 


Figure 7.8.1. Controller architecture from computer perspective. 


mechanical devices they are controlling and should not present a problem. Also 
as noted earlier, the servos are interpolating data and are performing at a faster 
rate (e.g., 1 msec updates) than the set point information is being sent from the 
host (e.g. dates). _ 
ti se ayy ae . ) vantageous in coupling job-specific hardware devices 
into the system. For example, if we wished to add vision, it would be a self- 
contained system and would merely send or receive position information over the 
common bus for use by the host when necessary. Additionally, gic mpm a 
force-controlled gripper, hardware specific to this task could be addec ak ie could 
Perform such tasks as signal processing (for use with a force sensor) and servo 
control of the gripper’s actuator. The host would merely send a signal to the 
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e Every T sec host writes DIS to common bus and all joint processors on bus receive it simultaneously 
e Each processor computes CRC as a validity check 
e Each processor interprets global command byte and takes its appropriate data 


e Any information that the processors are to send to the host are written to the appropriate location (such as 4 
response to the last command byte) 


e T/K sec after T the host interprets the information written into the DIS 
e The cycle repeats forever 


Figure 7.8.2. Data transfer between host and joint processors. 
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computer to close and exert a force of say 8 oz. Once the processor received the 
command, it would perform its task independently of the “central control unit”’ 
and upon completion of its task send back a signal indicating success or the reason 
for failure. 

To facilitate the “‘teaching”’ of points, the system may include another program 
by which the trainer uses a joystick, keys, or other control to cause the manipulator 
to move either in a joint-by-joint fashion or along a straight line. In either case, 
set points are generated and fed to the servos, which in turn must report their 
positions back to the control program. When the trainer is satisfied with the 
position of the manipulator, the values of all the variables relating to the position 
of the manipulator are saved and given a name such as “‘this_point.” While the 
name ‘‘this_point” may be associated with a specific position of the manipulator, 
it should be understood that this may be a complex data structure and will carry 
information not readily apparent to or needed by the trainer. 

Once this type of system has been designed and debugged, it will be used by 
people who may be less skilled in the art than its designers. From the user’s point 
of view, the functionality described in Section 2.4 is implemented primarily by 
high-level programming instructions. For example, using the programming lan- 
guage, the trainer may command the robot to go in a straight line from its current 
location to another simply by using a function such as 


move_straight_to€next_point); 


The argument of the function “next_point” may have been created by the “teaching 
program’’ discussed previously. , 
As pointed out earlier, the function “move_straight_to( )” was defined by 
the designers, and the details of its exact implementation are probably of little 
interest to the user, whose primary interest is to be able to use the function along 
with some data to cause the manipulator to perform a specific function. Ofcourse, 
other functions must also exist in the library. These instructions provide the ability 


to perform the following actions: 


e Wait a specific amount of time. 

e Set the binary outputs to a particular state. 

e Read the binary inputs (from external sensors) and the state of the gripper 
(i.e., opened or closed). 


Besides the functions provided for specific robot control, the commercial 
Operating system gives the user the ability to perform “housekeeping functions” 
and Supports any other programs needed to support the robot programming en- 
vironment. 

In summary, this section has attempted to give the reader some insight as to 
how computational elements and software come together to form a robot controller. 
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Of paramount importance was the need to implement a certain level of functio 
with standard software and hardware so that the ultimate end user could ha 
ability to define a robot task. 


Nality 
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7.9 SUMMARY 


In this chapter we have discussed many topics relevant to computer considerations 
for robotic systems. The picture presented here is a snapshot of numerous tech- 
nological considerations that are changing rapidly, and thus the specific materia] 
in the chapter may be quickly outdated. The general topics treated here will not 
become outdated, however, and for this reason one must develop a general set of 
methods to evaluate new advances in robotic software, communications, cell con- 
trollers, and other robotic computer-related subjects. Although the specific robot 
languages or the specific interface protocol may change, the role that these tech- 
nological components play will be more or less consistent. 

The authors cannot emphasize enough the importance of evaluating the com- 
puter elements in a robotic system, and being aware of changes in technology that 
may alter the specific value of a specific technique. For this reason the authors 
expect that the reader will need to be aware of the general importance of these 
issues and can analyze them as technology changes. 


7.10 PROBLEMS 


7.1 Design the software architecture of a robot controller that utilizes a multitasking op- 
erating system to provide the following: 


Service a terminal 
Interpret terminal commands 
Perform computations 
Wait for the specific events 
—joints at set points 
—intrusion detection 
e Execute the instructions of a robot program 


Modify the design so that an editor may run and a program be entered while the 
robot controller is running another program and executing its other defined tasks. If 
you had to prioritize activities, which would be the most important; the least important? 

7.2 Pick a specific processor (such as a 68000 or 8086) and investigate what commercially 
available bus architecture, operating systems, and programming languages are available. 
Based on robotic considerations as defined in Chapters 2 and 7, what combinations 
provide the most support for the desired functionality at the least cost? Which provide 
the most flexibility? 


7.3 Based on the discussions in Chapter 8, determine the time it takes to multiply tw° 4x4 
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matrices using languages such as BASIC, FORTRAN, Pascal, and C; also determine 
the time factor if coded in Assembly language. Use a computer with support for more 
than one of these languages to simulate this. Consider fixed-point and floating-point 
numbers along with a general matrix multiplication routine and one that is specific to 
DH matrices. 

7.4 Using the fixed instruction sequence control definition of the MAKER 100 Mark 1 
controller (see Section 7.6.1.1), program-the stacking application (which was accom- 
plished in VAL (see Table 7.6.2) and described in Section 7.6.3). Assume that there 
are eight binary outputs and that straight-line motion is possible. Use mnemonics to 
define positions (remember that each position must be taught previously) and other 
operations such as gripper state and the states of output lines. Since no terminal device 
is available, use a subset of the binary outputs to indicate which object has been stacked, 
and a special one to indicate that the program has completed its task. Comment on 
the fixed instruction sequence versus the VAL implementation. 

7.5 Obtain descriptions of at least two commercial programming languages from their man- 
ufacturers. Use these languages to reprogram the stacking application (see Table 7.6.2 
and Section 7.6.3). Compare and comment on the similarity of the functionality of the 
different languages (for instance, straight line motion, operations on positions in space, 
terminal display, and so on). Are any of the languages better for performing this 
object-stacking application? Next consider the programming skill required for each 
language and comment on whether people with explicit computer programming skills 
could easily understand the construction of the language and effectively use it. For the 
languages you have chosen, are any applications better suited for implementation by 
one versus the others? 

7.6 Using a personal computer, program a robot simulator using two-dimensional graphics 
and a fixed instruction sequence control scheme. For example, assume that we graph- 
ically show the x-y plane of a r-@ manipulator and the annulus of its workspace. Also, 
the display will be used to trace the trajectory of the tool tip of our simulated robot. 
Moreover, the state of each of the output lines will be shown along with any other 
pertinent information. 

Define a fixed instruction sequence set (similar to that of the MAKER 100 de- 
scribed in Section 7.6.1.1). One possible suggestion is to input the robot program into 
a file which is read by your simulation program. As each instruction is read from the 
file, update the display to show the manipulator position, output line state, gnpper 
state, and so forth. Note that it may be necessary to query for the input states prior 
to updating the display. 

7.7 Find commercial examples of robotic extensions to computer languages. Comment on 
the similarity of the extensions in terms of functionality. 
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Transformations and Kinematics 


8.0 OBJECTIVES 


The purpose of this chapter is to introduce the concepts of “homogeneous coor- 
dinates” and “‘coordinate transformations.”’ When utilized in the framework of 
the kinematics of robots, these concepts provide a concise mathematical formu- 
lation to describe the position and orientation of a manipulator and open up ways 
for generating more complex motions than can be obtained by moving joints in- 
dividually or in a “‘joint-interpolated” fashion. Recall from Chapter 2 that joint- 
interpolated motion refers to a motion in which all joints start and stop simulta- 
neously, and whose trajectory (path traced by the tip of the arm) does not generally 
follow a well-defined Cartesian path such as a line or the arc of acircle. However, 
straight-line motion algorithms and task descriptions are readily described in terms 
of homogeneous coordinates and transformations without the need for considering 
the particular geometry of a robot until the joint positions are needed. In addition, 
positions defined in terms of homogeneous coordinates may be related to one 
another by simple matrix transformations. This concept provides the means to 
easily determine the location of objects whose exact position may be unknown but 
which have been defined with respect to some other known locations or objects. 


In this chapter we present the following topics: 


e Homogeneous coordinates 
e Transformations 


561 


562 Transformations and Kinematics Chap 9 


Coordinate reference frames 

Description of points and objects in terms of transformation matrices 
Kinematic equations (the forward solution) 

Reverse (back) solution 

Transformation matrices applied to motion control 

The Jacobian 

Continuous path algorithms 

Trajectory control 

e Controller architecture 


8.1 MOTIVATION 


In describing the position and orientation of a manipulator, one may choose to 
use various types of coordinate reference frames. The configuration of the robot 
may be such that the joint motions correspond naturally to the variables associated 
with Cartesian, cylindrical, or spherical reference frames (see Chapter 1). Other 
configurations may produce more intricate geometric relationships. In addition, 
the manipulator may provide more degrees of freedom than are associated with 
position in three-dimensional space. Specifically, once the end of the manipulator 
is located, its orientation may also be changed. Therefore, in describing the 
position of a robot and the gripper or tool it is carrying, we define both the position 
and orientation of the tool with respect to some reference frame. 

Since the control strategy used in most robots is based on the ability to control 
the position of the joints (typically, most feedback devices are located in a manner 
so that they monitor joint position and velocity), the most natural reference frame 
for a robot is defined by its joints. With the contro] system monitoring and 
controlling joint positions and velocities, it is quite simple to move the robot about 
by changing the positions of each of its joints. A particular position of the ma- 
nipulator or its tool may be defined in terms of a set of joint positions. Figure 
8.1.1 shows a five-joint manipulator with a set of “rulers” attached to each of its 
joints. By selecting a point on each of the rulers as a reference point, the position 
of each joint may be defined. We define the term joint space as the space in which 
the position of the manipulator is described by a joint vector whose components 
are the positions of each joint. A point in a robot’s work volume is in its joint 
space. Figure 8.1.2 shows the robot of Figure 8.1.1 tracing out a plane in its 
workspace. 

The joint vector is defined as a column matrix containing the positions of the 
joints or a value associated with each joint variable at a given point in the workspace 
with respect to some calibration point. This point sets the reference for measuring 
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Figure 8.1.1. Robot and joint measurements. 


joint angles or joint displacements. We define a joint vector J (not to be confused 
with inertia) as follows: 


0; 


(8.1.1) 


Vin 
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Figure 8.1.2. Robot and plane in its workspace. 


where 0, through 0, define the angular positions of rotary joints and r, through r,, 
define the linear extensions of prismatic joints. The dimension of the joint vector 
is dependent on the number of axes of the manipulator. 

Using this type of position representation with position servo control of each 
joint, one may teach locations in space by manually moving each joint until the 
tip of the manipulator is at the desired location. Once the location is reached and 
has stabilized, the value of the joint vector may be recorded for later reference. 
Typically, the values corresponding to the joint positions are stored in memory for 
use at a later time. This is the approach used to teach most robots. 

If the only way we have to position a manipulator in its workspace 1S by 
manipulating the joint positions, the limitations of positioning or teaching the 
manipulator become quite clear. Consider the problem of attempting to trim UP 
Fst eam eed al endpoint 
with six rotary joints (refer a he ies Peston: om the case of a mani a 
at dh sass aeetihen tere estan robot configurations in Chapter 1), it oe 
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difficulty of this particular motion will tend to change with different robot config- 
urations. 

A more complicated example to illustrate this problem further is to require 
the tip of the manipulator to move along a straight line defined only by its two 
endpoints, which would correspond to two joint vectors. Once again, depending 
on the configuration of the manipulator, it may be extremely difficult to generate 
a simple algorithm to compute the intermediate points working only in joint co- 
ordinates. 

A solution to the positioning problem is to be able to represent positions and 
orientations of the tool point or tool tip (see Chapter 2) in a convenient coordinate 
system rather than being forced to work solely in the coordinate system defined 
by the joints of the manipulator. This lets us use the most convenient coordinate 
representation for the task at hand and simplifies the generation of curves and 
straight lines by the tool (or end effector). 

The most natural coordinate system for human beings is the standard Carte- 
sian system. We tend to think in straight lines, for example, ““move up a few 
inches” or “‘move along a diagonal” to some point. Similarly, most machine tools 
do the same thing and reference coordinates to a “datum.” This datum establishes 
an x-y or xyz frame to a workpiece and allows a machinist to drill holes in the 
correct locations. Although Cartesian coordinates (or distances as pointed out 
above) may be advantageous in certain circumstances, other coordinate systems, 
such as cyclindrical, spherical, or even the joint space of the robot itself, should 
not be dismissed. 

To establish the location of the tool tip of the robot in the coordinate frame 
being used (consider Cartesian), the joint vector of the manipulator must be mapped 
into Cartesian space. This mapping provides an additional method of recording 
points, in that the location may now be stored as Cartesian coordinates as opposed 
to joint coordinates. 

Regardless of the complexity of the desired coordinated motion (e.g., straight 
line in Cartesian space, or a circle defined in cylindrical space) to ultimately control 
the robot, the joints must receive the appropriate position values. This establishes 
the need for a method of mapping the particular reference frame in which the 
motion is defined into joint space. As we shall see later on in this chapter, the 
Mapping from joint space to Cartesian space may not be unique. 

Homogeneous transformations provide the mathematics for describing points 
with preferred orientations in three-dimensional space. Matrix operators applied 
to homogeneous coordinates allow points to be rotated about axes, translated in 
space, and referenced relative to other points and to other reference frames. We 
may also define relationships that map the coordinates of spherical or cylindrical 
frames into Cartesian, or vice versa. 

Using the framework of homogencous transformations, the serial links of a 
manipulator may be modeled as a set of reference frames whose relative positions 
and orientations are determined by the values of the joint variables. By relating 


566 Transformations and Kinematics Chap. g 


successive frames to each other (i.e., starting at the base of the robot and endin 
at the gripper), the “forward solution” (joint vector to Cartesian representation) 
is obtained. This provides a means of mapping an n-dimensional joint vector to 
Cartesian space, giving both the position and CHEnESIOn of the gr “EPS with respect 
to a predefined Cartesian coordinate system. The “inverse (or back”’) Solution 
maps Cartesian position and orientation to the n-dimensional joint vector, Ty; 
solution is essential for implementing complex coordinated motions such as straight 
line or positioning the manipulator if the position is defined in any reference frame 
other than joint. 

Coupling the matrix operations, homogeneous transformation representation 
of positions, and forward and reverse solutions along with some motion algorithms 
provides the entire framework for complicated robot control and motion trajec- 
tories. Each of these subjects is now considered in turn. 


8.2 HOMOGENEOUS COORDINATES 


Recall that a vector is a quantity that has both magnitude and direction. It is 
usually represented by an arrow of length equal to its magnitude and pointing in 
the appropriate direction. An alternative notation utilizes a linear combination 
of a set of basis vectors. For vectors in Cartesian coordinates, the basis is a set 
of unit vectors directed along the orthogonal x, y, and z axes used to represent 
this space. Thus a vector v can be written as 

v=xi+ yj + zk (8.2.1) 
where the unit vectors {i, j, k} have been weighted by the appropriate constants 


Z axis 


(x,y,z) 





: (0,0, 1) 
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in 
Figure 8.2.1. Vector and basis set 


Cartesian reference frame. 
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(x, y, Z) (see Figure 8.2.1). Our notation for vectors will be a boldface upper of 
lowercase letter (sometimes with a subscript). Unit vectors will be boldface low- 
ercase letters with a circumflex (*) above them. 

In the special case where the vector originates at the origin of the coordinate 
system and terminates on a particular point (x, y, z), we may also think of this as 
a representation of the point. Throughout the rest of our discussion this will usually 
be the case. 

Another way of representing a three-dimensional vector is by using homo- 
geneous coordinates. In this representation a fourth component which acts as a 
scaling factor is added. The physical coordinates [which were the basis coefficients 
in Eq. (8.2.1)] are obtained by dividing each component in the homogeneous 
representation by the scale factor. Since we would like this representation to 
generate the same vector as our previous method [i.e., Eq. (8.2.1)], the components 
are also multiplied by this scaling factor. The homogeneous coordinate represen- 
tation for the vector defined by Eq. (8.2.1) is written as the column matrix 


, 


x 
v=|7, (8.2.2) 
z 
S 
where: 
x’ = 5X 
y’ = sy 
* = 52 


and s is the scaling factor. 
If the value of the scaling factor s is set to 1, the components of the homo- 


geneous and standard Cartesian representations are identical. The importance of 
the fourth element will become clear when we introduce matrix operators. 
A numerical example illustrating the two types of vector representations Is 


shown below. 


EXAMPLE 8.2.1: VECTOR REPRESENTATIONS 


Cartesian basis representation: 


Homogeneous representations: 
3 6 — 30 
4/ | 8] _ | -40 ; 
V=!5]~ | 10} ~~ | -SO (8.2.4) 
| 2 —10 
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This example points out that the homogeneous coordinate representation for 
a vector is not unique. In Eq. (8.2.4), three of the many possible column Matrices 
which could represent v are shown. Each of these column matrices represents the 
Same vector in three-dimensional space. . 

When the scaling factor s is set to 0, the vector in homogeneous coordinates 
represents a direction. This is easily seen if we imagine a limiting process Where 
we let s approach zero. As s approaches zero, the vector components become 
infinite. Thus direction vectors pointing along the x, y, and z axes can be rep- 
resented as follows: 


(8.2.5) 


| 
oon 


(8.2.6) 


Se 
| 
OO KF © 


(8.2.7) 


> 
oro © 


In the case of the representing direction, it is a good idea to ensure that the 
entries x’, y’, z' have been normalized. This prevents unnecessarily large numbers 
from being carried. Recall that the normalization for vectors represented by Eq. 
(8.2.1) is accomplished by dividing each component of the vector by the square 
root of the sum of the squares of the individual components (i.e., the vector norm). 
This ensures that the resulting magnitude of the vector (i.e., the square root of 
the sum of the squares is equal to 1). 


The null vector representing a point at the origin of a reference frame is 
defined as 


(8.2.8) 


ao © © 


where s, the scaling factor, can be any number other than zero. We will usually 
use scaling factors of 1 for our work. Thus the null vector will also use a scaling 
factor of 1. Physically, the null vector represents the origin of a coordinate ref 
erence frame. A vector is undefined if all the entries are zero. 
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8.2.1 Vector Operations 


Many operations may be performed on vectors. 
such as addition, subtraction, and multiplication by a scalar. Also, two common 
vector operations are the dot product (a - b) and the vector cross product (a x 
b). The former generates a scalar result, while the latter results ina vector. These 
operations are important in determining the normal to a plane and whether points 
areinaplane. Various texts on vector analysis describe these tests and operations 
in detail [3], [11]. 

Recall that the homogeneous representation included a scaling factor, s. Thus, 
when adding or subtracting vectors defined in this manner, it is necessary to com- 
pute the coefficients of the basis set and then perform the operation since the scale 
factors of the two vectors may not be equal. The scale factor for the resulting 
vector can be set to any nonzero value as long as each of the coefficients of the 
result is adjusted properly. The final result is placed in the format of the ho- 
mogeneous coordinate column vector. 

The multiplication of a vector by a scalar results in each component of the 
vector being multiplied by the scalar. In the case of the homogeneous represen- 
tation, however, it is important to note that if a scalar multiplies all four compo- 
nents, we have not changed the vector, as should be evident from the results of 
Example 8.2.1. Therefore, when performing multiplication by a scalar it is im- 
portant that the scale factor s should not be multiplied by the scalar. Otherwise, 
all that is accomplished is to obtain an equivalent representation as shown in 
Example 8.2.1. An alternative way to perform scalar multiplication of a vector 
represented by homogeneous coordinates is to adjust the scale factor and leave the 
original components alone. For example, to multiply the vector of Eq. (8.2.4) by 
2, all that is necessary is to divide s by 2. 

The proper use of the scale factor for the dot and cross products is illustrated 
in the following examples. 


0 ee 
EXAMPLE 8.2.2: DOT PRODUCT EQUATIONS 


Obtain the Cartesian and homogeneous representations for the dot product 
of the two vectors x and y. 


These include the typical ones, 


Cartesian basis representation 


x = ai + bj + ck (8.2.9) 
y=di+ej+ fk (8.2.10) 

Using the definition of the vector dot product, we find that 
xy = (ad + be + cf) (8.2.11) 


Homogeneous representation. The same vectors represented in ho- 
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mogeneous coordinates are given by 


a 
x = 7A (8.2.12) 
w 
Ay 
y = : (8.2.13) 
; 
where: 
a’ = aw 
b' = bw 
c' = cw 
d' = dr 
e' = er 
fl = fr 


By using the appropriate coefficients (a, b, c, d, e, f) from Eqs. (8.2.12) and 
(8.2.13) in Eq. (8.2.11) we obtain Eq. (8.2.14) which defines the dot product 
in terms of all the column entries. 
‘a a6 b' / + ‘ft 
x'y= aad +bet+ef (8.2.14) 
wr 








EXAMPLE 8.2.3: CROSS-PRODUCT FORMULAS 


Obtain the Cartesian and homogeneous representations for the cross product 
of the two vectors x and y of Example 8.2.2. 


Cartesian basis representation. The vector cross product is defined as 
x X y = (bf — ce)i + (cd — af)j (ae — bd)k (8.2.15) 
Homogeneous representation. By substituting the coefficients (a’ through 


f’) from Eqs. (8.2.12) and (8.2.13) into the definition of the vector cross 
product [Eq. (8.2.15)], the following representation is obtained: 


b'f' — c'e’ 
ex y= |[C@ — af (8.2.16) 
a‘e’ — b'd' 
uw 


—$—$—————————_——— ea eee”, 
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3.2.2 Matrix Operators: Transformations 


In addition to performing the vector operations outlined previously, it is possible 
to define a class of matrix operators that can perform simultaneous vector oper- 
ations resulting in the translation or rotation of a vector. The matrix H will be 
considered such an operator, which transforms a point or vector x into another 
point oF vector y. 


y = Hx (8.2.17) 


Recall that the order of a matrix is defined as the number of rows r by the 
number of columns c. Thus the order of a matrix, having r rows and c columns 1s 
(rx c). A (4 x 1) column matrix for y is obtained by premultiplying a (4 x 1) 
column matrix, x by a (4 X 4) H matrix. This follows from the requirement that 
H and x must be conformable; that is, the number of columns in H is equal to the 
number of rows in x. 


8.2.2.1 Translational transformations 


We define the translational transformation Trans(a, b, c) as the operator that 
moves the point defined by the original vector x to a new point y whose location 
is given by the vector addition of x and a translation vector defined by the com- 
ponents a,b, andc. This is essentially vector addition. An interesting interpre- 
tation can be obtained by considering moving a point from its current location for 
some distance along a diagonal. The distance is the vector magnitude, while the 
diagonal is defined by the direction of the vector. The operator transforms the 


coordinates of the Original vector into the coordinates of anew vector. This matrix 
Operator is defined as follows: 


Trans (a, b, c) = (8.2.18) 


oOo oo - 
oor © 
or OG © 
Re AO && 


“ae a,b, andc represent the components of the vector which are to be 

Siar those of the operand x of Eq. (8.2.17). From our prior discussion 

renites ng Matrix addition, this matrix will operate properly on any homogeneous 
entation of a vector, independent of the value of its scaling factor. 


mot; The following example illustrates both the vector addition concept and the 
‘On along a vect 


~ or for a prescribed distance. 


EXA 
MPLE 8.2.4: TRANSLATION OF A POINT 


Suppose that a 
Tame. 


an angle 


point p lies at (x, y) = (5, 5) in a two-dimensional reference 
It is desired to move the point along the diagonal corresponding to 
Ra Of 45° for a distance of 10 units. What are the coordinates of the 
Point p’ (x,, y2)? Figure 8.2.2 illustrates the initial and final positions. 
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Final , 
Point » ? 
Y2 





Initial 10 


Point 
p 


45° 





Figure 8.2.2. Translational transform 


example. 


5 X2 


The original point may be represented as a vector in homogeneous 


coordinates. Its value iS 


5 
5 

i (8.2.19) 
1 


Since it is desired to move the point along the 45° radial extension, the unit 


vector corresponding to this direction is 

0.707 

om (8.2.20) 
1 


To get a motion of 10 units it is necessary to multiply the components of u 
by 10, excluding the scaling factor, as mentioned previously. The new vector 


u becomes 

7.07 

_ (8.2.21) 
1 


which can be considered a point 10 units from the origin along the radial line 
at 45°. Using Eqs. (8.2.17) and (8.2.18) we obtain the expression for the 
translated point p’. 


ao! 
| 
ooo Ke 


07115 
-07 |} 5 22) 
> Io (8.2. 

1 1 


Socorro 
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where we have substituted the components of u for a, b, and c. Carrying 
out the multiplication in Eq. (8.2.22) yields 


12.07 
, _ | 12.07 
P 0 


i 
ee 


(8.2.23) 


This simple example points out the two ways that one may view the trans- 
lational transformation (i.e., as vector addition or as ‘‘motion along a line’’) and 
is extremely useful in indicating why the scaling factor is important. Consider the 
generation of one element of the p’ vector of Eq. (8.2.23), say the x component. 
In Eq. (8.2.22), the first row of the Trans (a, b, c) matrix selects the x component 
from vector p and then adds the x component of the translation vector times the 
scale factor of p. Finally, when the scale component for p’ is computed, it is the 
original scaling factor of the input vector p. Thus before adding the vectors, the 
components of the last column of Trans (a, b, c) are scaled by the proper constant 
so that like quantities are added. Finally, the actual value is generated and the 
original scaling factor is preserved. 


8.2.2.2 Rotational transformations 


In addition to moving points along vectors, it is possible to generate new 
positions in space by rotating them about an axis. Before investigating the rota- 
tional matrix operator, we will derive the rotation formula for a set of orthogonal 
axes rotated in a plane. Our derivation is based on a geometric interpretation as 
given in [4]. 

Consider a point P located at x,, y,; with respect to the x-y reference axis, 
which we shall call x-ref and y-ref (see Figure 8.2.3). In addition, assume initially 
that a second set of axes is lying on top of the reference axes. This set will be 
called x-rot and y-rot and the relationship of the point P with respect to these axes 
will remain fixed. Now assume that the plane containing the point P (located 


y-ref 


Y; e 


x-ref 


Reference axis Figure 8.2.3. Point in reference frame. 


ne ee 
anasto a ~ 
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x-rot 





Figure 8.2.4. Point rotated with re. 
Xo x-ref spect to reference frame. 


in the frame defined by x-rot and y-rot) is rotated counterclockwise by an angle 9 
with respect to the reference axes. We would like to determine the location of 
the point P with respect to the reference axes (x-ref and y-ref as shown in Figure 
8.2.4). 

Figure 8.2.5 shows the geometric construction necessary to determine the 
coordinates. Line segment PA is the perpendicular from the point P to the x-ref 
axis. Line segment PB is the perpendicular from the point P to the x-rot axis, 
From the diagram we may write the following relationships: 


x, = |OA| = |OE| — |AE| 
y. = |AP| = |AC| + |CP| 
|OE| = |OB| cos 6 
= xX, cos 6 
|AC| = |EB| = |OB| sin 0 
= X, sin 0 
|AE| = |CB| = |BP| sin 0 
= y, sin 8 
|CP| = |BP| cos 6 
= y, cos 8 


Combining these equations yields the desired results: 


X, = X, cos 0 — y, sin 6 (8.2.24) 
yo = X, Sin 8 + y, cos 0 


The relationships above allows us to determine the location of points affixes 
to movable frames of reference in terms of a fixed reference frame. The derivate! 
in the x-y plane is easily extended to either the y-z or z-x plane. 
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y-ref 
y-rot 
Y2 P 
\ x-rot 
B 
Y1 c e\. 
Xy 
ae Py) 
0 Xo E x-ref 


A 


Figure 8.2.5. Geometric construction for rotation of axes. 
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Rotational transformations which operate on homogeneous coordinates and 
perform rotations about a given axis of the reference coordinate system can be 


shown to be: 


1. Rotation 6 degrees about the x axis: 


1 O 0 0 
_ |0 cos6 —sin®@ O 
Rot (x, 6) = 0 sin 6 see ($.2.25) 
0 0 0 1 
2. Rotation 6 degrees about the y axis: 
cos®@ O sin 8d QO 
0 1 0O 0 
Rot (y, 8) = —sind 0 cosé@ 0 (8.2.26) 
0 0 0 1 
3. Rotation @ degrees about the z axis: 
cos6@ -—sin@ O QO 
sin 0 cos6 0 0 
0 0 0 1 
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TABLE 8.2.1 POSITIVE ANGLE 


REFERENCES 

Cross product Rotation 

xX y=z2 Positive rotation about z 
yXz=x Positive rotation about x 
zXx=y Positive rotation about y 


ee 


| Examining the matrices in Eqs. (8.2.25) through (8.2.27) shows that the 
entries of the last column are all zero except for the scaling factor, which has been 
set to 1. This is reasonable since we do not wish to do any translation. The first 
three columns represent the directions of the x, y, and z axes of the rotated frame. 
Observe that the scaling factor is set to zero in each case. For Eqs. (8.2.25) 
through (8.2.27) the axis about which the rotation is performed has a unit entry 
in the appropriate column showing the direction of that particular axis. For ex- 
ample, in Eq. (8.2.27) the 1 in the third column shows that rotation is about the 
Z axis. The columns corresponding to the direction of the axes forming the plane 
in which rotation takes place contain the transcendental terms needed to accomplish 
the rotation. For example, in Eq. (8.2.25) columns 2 and 3 indicate a movement 
of the y-z plane. 
| To visualize the concept of rotating a point about an axis, the reader should 
imagine a perpendicular drawn from the point to the axis about which it will be 
rotated. If one were to rotate the initial perpendicular, an angular displacement 
would result. The angle of rotation may be positive or negative and is defined by 
using the right-hand rule. Rotation is positive if the cross product defined by the 
initial and final vectors is in the same direction as the axis about which the rotation 
was performed. The cross products of the x, y, and z axes are shown in Table 
3.21. 

The following example shows the effects of operating on a point or vector 

with a rotational operator. 





EXAMPLE 8.2.5: ROTATION OF A POINT ABOUT A REFERENCE FRAME 


It is desired to rotate the point u represented by a column vector about the 
z axis and determine the coordinates in terms of the original reference frame. 
Figure 8.2.6 shows this operation. The vector u will be given as 


u = 


1 
2 
: (8.2.28) 
1 


One may also think of this problem as the rotation of a plane located 
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Z 
; 
y-|2 
eae 
1 
~ 1,232 
Z y= | 1-866 
\ '= 1 3.000 
60° 1 
u 
Vs “40 
V2 = 
90° 2= 1 30 
Mb ! 
“I V2 _ 2.232 
y= |-0-134 
x 3 3.000 
1 


Figure 8.2.6. Rotation of a point about the z axis. 


at a height of 3 units above the x-y reference plane which contains the point 
(1,2). The relationship of the point (1, 2) remains the same to the reference 
frame of the plane in which it is located but is different from the base or 
original x-y reference frame located at height z = 0. Using Eq. (8.2.27) we 
will consider rotations of 60°, 90°, and 120°. The operators corresponding 


to these angles are given as 


0.500 —0.866 0 0 
Rot (z, 60) = | 7°80 ONO (8.2.29) 
0 0 01 
0 -1 0 0 
Rot(z,90)=|9 9 1 9 (8.2.30) 
0 001 
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_9.500 —0.866 9 0 
0.866 —0.500 0 0 

Rot(z, 120) = 0 0 1 0 ($.2.31) 
0 0 0 il 


If each of the operators defined by Eqs. (8.2.29) through (8.2.31) is applied to the 
vector u, using Eq. (8.2.17), one obtains 


~ 1.232 
866 
: oa (8.2.32) 
1 


_2.0 
— *y (8.2.33) 
1 


— 2.232 

—0.134 
3000 (8.2.34) 
1 


where Vj, V>, V3 represents a vector to the rotated point after 60°, 90°, and 120° of 
rotation, respectively. 


Oe 


Based on the three rotational transformations [Eqs. (8.2.25) through (8.2.27)| 
about the primary axis, we may begin to define compound rotational transfor- 
mations. These will consist of rotations of a point or vector about an axis, followed 
by another rotation of the result. Since we have chosen a matrix and vector 
representation for these operations, it is possible to string matrix operators together 


to perform these multiple rotations without the need to compute intermediate 
results. The following example illustrates this. 


V¥i= 


V3 >= 


EXAMPLE 8.2.6: MULTIPLE ROTATIONS 


Considering the results of Example 8.2.5, suppose that it is desired to rotate 
the point v, (obtained by rotating u 60° about the z axis) —90° about the y 
axis, resulting in a new vector, w. The operation becomes 


w = Rot(y, —90)v, 


(8.2.35a) 
w = Rot(y, —90)(Rot(z, 60)u) (8.2.35b) 
w = (Rot(y, —90) Rot(z, 60))u (8.2.35¢) 


Using the associative law as illustrated in Eqs. (8.3.35a), through (8.3.35), 
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Figure 8.2.7. Rot (y, —90°) Rot (z, 60°). 


we may generate the transformation Rot (y, —90) Rot (z, 60). Thus 


0 0 4, 
_ | 0.866 0.500 0 0 
Rot(y, —90) Rot(z, 60) = |g 59g _—0.266 0 0 (8.2.36) 
0 v 0 1 
Using this compound operator on vector u yields the new vector: 
— 3.000 
1.866 
w= | _ 1939 (8.2.37) 
1.0 


— Figure 8.2.7 shows these rotation operations. 
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Since matrix operations are generally not commutative, the order in Which 
the rotations are performed becomes quite important. In general, the product of 
elementary rotational transformations taken in different order will yield different 
results. Consider first a rotation of —90° about the y axis followed by a rotation 


of 60° about the z axis. The product of the two elementary transformations is 
given by 


0 —0.866 —9.500 0 
0 0.500 —0.866 0 

Rot(z, 60) Rot(y, —90) = 1 0 0 0) (8.2.38) 
0 0 0 ] 


The result of this transformation operating on u is shown in Figure 8.2.8. The 
new vector becomes 


~ 3.232 
| — 1.598 
w=| 75 (8.2.39) 
1.0 


N 

il 
————E—s 
=-WN-— 
a | 


“=| 


— 3.232 
w' =| Mies = Rot (z, 60) vj 
u 1 


—_ — A W 


= Rot (y, —90) u 


ian 


Figure 8.2.8. Rot (z, 60°) Rot (y, —90°). 
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Comparing the results of the operators defined by Eqs. (8.2.36) and (8.2.38), it is 
seen from Figures 8.2.7 and 8.2.8 or Eqs. (8.2.37) and (8.2.39) that they are not 
the same. The order in Which the rotations are performed generates different 
results. This 1s expected since matrix multiplication is generally not commutative. 

An interesting application of the rotational transformation is to provide ad- 
ditionally incremental angular motion. Suppose it was desired to rotate a point 
60° about the z axis followed by another 60°. Application of the operator Rot(z, 
60) will accomplish the first motion. Reapplication will provide the second motion. 
The reader can verify this applying the results of Example 8.2.5. The reader 
should also verify the general relationship for rotation about a given axis, that is, 


Rot(axis, 9; + 0. +--+ + @,) 


= Rot(axis, 6,) Rot(axis, 6,) - - - Rot(axis, 6,) (8.2.40) 


In Eq. (8.2.40) the operators may be commutative if we are concerned only with 
the final result and the rotation is about only a single axis. It is important to 
understand that as soon as multiple rotations about different axes are performed, 
the results above do not generally hold. 


8.3 COORDINATE REFERENCE FRAMES 


The translational and rotational operators introduced in Section 8.2 are examples 
of homogeneous transformations. The most general form of the homogeneous 
transformation performs both the operations of translation and rotation when ap- 
plied to a point. The power of this matrix operator lies in its ability to transform 
points from one frame of reference to another. In addition, the 4 x 4 transfor- 
mation matrix [refer to Eqs. (8.2.17), (8.2.18), and (8.2.25) through (8.2.27)] may 
be interpreted as the representation of a frame in space with respect to another 
frame, or even as a point in space. These concepts, extremely important in de- 
scribing the position of a robotic manipulator, permit the introduction of relative 
points and frames of reference. As a consequence, the amount of explicit infor- 
mation necessary to describe or teach a robot task is greatly reduced. 
In Section 8.2 all the vectors (which we used to describe points) were located 
In an orthogonal reference frame. Elementary matrix operators [i.e., Rot (-) and 
Trans (-)] operating on these vectors moved them about in space with respect to 
the given reference frame. Let us now consider a space consisting of two orthog- 
Onal reference frames whose origins are displaced as shown in Figure 8.3.1. The 
Origin of frame 2 is at coordinate (x, y, Z) with respect to frame 1, as shown by 
the vector p. Note that the axes of each frame are aligned in different directions 
and for simplicity are either parallel or antiparallel to axes of the other frame. 
his assumption is for illustrative purposes only and the results obtained in the 


following derivation will apply to any other orientations. | | 
What is sought is a way to reference points which are described in terms of 
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Figure 8.3.1. Three-dimensional space with two reference frames. 


the coordinates of frame 2 in terms of the coordinates of frame 1, and vice versa. 
This gives us the ability to refer to a point using the coordinates of the most 
convenient reference frame. The application of these ideas will be illustrated in 
the sections that follow. 

The derivation begins by assuming that two coordinate frames are initially 
aligned in such a way that their origins and axes are all coincident. These two 
frames will be located at frame 1 of Figure 8.3.1. One set of axes will remain 
stationary, while the second set will be moved through space. The motion of the 
second axis is obtained by assuming that a particular point, say the origin, 1s 
operated on by the rotational and translational operators introduced in Section 
8.2.2. For these manipulations, besides rotating and translating the point about 
the reference axes, the coordinate frame associated with this point will remain 
affixed to it. For example, if the origin was rotated by 90° about the z axis, the 
reference frame would be rotated with respect to the fixed frame by 90°. 

Table 8.3.1 shows two of three possible methods of using elementary ho- 
mogeneous transformations to cause the second (or movable) axes to be aligned 
with the coordinate axes labeled frame 2. The motivation for doing this is that if 
we know a vector (or a point) referenced to the movable frame. the relationship 
between that frame and the vector remains fixed, regardless of the location of that 
frame in space. Consider some vector referenced with respect to frame 2, Say 
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58.3 1 OPERATIONS TO LINE UP TWO FRAMES 
TABLE 
Method 1 Method 2 
Zi “I 
x1, Yi, 2; Movable axes x}, Yi, 2; movable axes 
coincident coincident 
with x1, Yi, 2; y with x;, Yi, 21 
1 fixed axes ' fixed axes 
x xy 
(a) 
zy 
a 
x - y. 
YI Rot (z,, 180°) ; z Rot (y,, 180°) 
1 
xX X 
(b) | (e) 
2) 
Yi 
x; 21 Rot (x,, —90° Rot (x,, 90°) 
Yi 
Xy 
(c) (f) 
Yi 
Vi 7 
x} i 
oe 2; ee ae 2 
Yi 
Trans (x, y, 2) X, Trans (x, y, 2) 





(d) 


[Xa Yar Zas 1]".* This vector always has the same coordinates in terms of the 
movable frame. Using the fixed frame as a point of reference we wish to know 
the coordinates of the vector (attached to the movable frame) in terms of this fixed 
frame. If the movable frame is made coincident with the fixed frame, the coor- 
dinates of the vector are the same in either frame of reference. Since the location 


ee a ae 
“tr indicates the matrix (vector) transpose. 
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and orientation of frame 2 with respect to 1 are known (see Figure 8.3.1) by 
performing operations on the point [X,, Yu Za 1)" (described in terms of frame 1), 
it is possible to make that point coincident with the point having the same coor- 
dinates with respect to frame 2. Assuming that the movable reference frame stays 
with the point during these operations, the final location of the movable reference 
frame will be coincident with frame 2. The operations performed (in a particular 
order) constitute the transformation that maps the coordinates of points referenced 
to the coordinate axes of frame 2 into the coordinate system of frame 1. 

Referring again to Table 8.3.1, we note that the rotation matrices are different 
for both cases. However, the product of the two rotation and one translation 
matrices of each method is identical. 

The product of transformations Trans (x, y, z), Rot (x, —90), Rot (z, 180) 
or Trans (x, y, z), Rot (x, 90), Rot (y, 180) generates a single 4 x 4 compound 
transformation which if applied to any vector defined with respect to frame 2 will 
give the coordinates of the vector in terms of the axes of frame 1. Note that it is 
always possible to make two reference frames coincident by performing at most 
two rotations about different axes of one frame and a translation. 

At this point we can define the homogeneous transformation matrix as the 4 
< 4 matrix having the property of transforming a vector from one coordinate 
system (or frame of reference) to another by means of performing simultaneous 
rotation and translation. Later we investigate a special form of this matrix 
called the Denavit—Hartenberg (D-H matrix) transformation matrix, which is 
used to relate to one another frames attached to each of the links of a robotic ma- 
nipulator. 

Table 8.3.2 shows how the general form of the homogeneous transformation 
can be partitioned into submatrices. The entries consist of a 3 x 3 submatnx 
responsible for the rotation and a 3 Xx 1 submatrix responsible for the translation. 
In addition, two other partitions may be identified as the perspective transformation 
and scaling factor. Typically, we set the scaling factor to unity, as discussed in 
the translational transformation example (see Section 8.2.2.1). The perspective 
transformation is set to (0, 0, 0) so that the columns of the rotation matrix taken 
along with the appropriate entry of the perspective transformation define direction 
vectors [such as Eqs. (8.2.5) through (8.2.7)]. In our applications the values of 
these two submatrices will always be defined as above. Additional details about 


the perspective transform can be found in [1]. 


TABLE 8.3.2 PARTITIONING OF 
THE HOMOGENEOUS 
TRANSFORMATION 





Position 
vector (3 x 1) 


Rotation 
matrix (3 x 3) 


— eee ee le — — = —, 
_— ree ae ee 


| 

| 

| 

| 
Perspective | Scaling 
transform (1 x 3) | factor (1 x 1) 

| 
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TABLE 8.3.3. VECTOR AND POSITION 
NOMENCLATURE FOR HOMOGENEOUS 
TRANSFORMATION MATRIX 





The real power of this matrix is seen by interpreting its columns. With the 
perspective transform and scaling factor set to the values mentioned above, the 
homogeneous transformation matrix may be interpreted as defining a relationship 
between two frames. Equation (8.3.1) shows the labeling of the individual vector 
components and positions. We may think of this matrix as containing the direction 
vectors for the x, y, and z axes of frame 2 written in terms of the directions of the 
x, y, and z axes of frame 1. For example, the elements of the first column (7,, 
ny, N,) are the components of the unit vector defining the x axis of frame 2, written 
‘n terms of the three unit vectors defining the axes of frame 1. The second column 
defines the y axis of frame 2, while the third column defines the direction of the 
z axis. The fourth column is the location of the origin of frame 2 with respect to 
1 and may be thought of as a vector (having coordinates p,, Py, p,) drawn from 
the origin of frame 1 to the point defining the origin of 2. 

In a later section we will use this matrix notation to define both the position 
and orientation of a robotic manipulator with respect to a reference frame. For 
now it is sufficient to say that a set of coordinate axes is attached to the end of the 
arm and the position of the manipulator is given by the relationship of these axes 
and the distance of their origin to the reference frame. When describing the 
position of a manipulator, conventional terminology refers to the z axis as the 
approach vector, the y axis as the orientation vector, and the x axis as the normal 
vector—thus the use of n, 0, a, and p in Table 8.3.3. The subscript indicates the 
x,y, and z components of that vector. This terminology will become more familiar 
and appropriate in a subsequent section when the kinematics of the manipulator 
IS discussed. 

. Based on the interpretation of the column vectors it is possible to write by 
spection a transformation matrix that relates points referenced in one frame to 
that of another. The following example illustrates this concept. 


EXAMPLE 8.3.1: FRAME-TO-FRAME TRANSFORMATIONS BY INSPECTION 


Suppose it is desired to find the homogeneous transformation that relates 
Points in frame 2 to frame 1 as shown in Figure 8.3.1. 

Based on the interpretation of the homogeneous transformation matrix 
mentioned above, we proceed by filling in the entries of the matrix in Table 


586 Transformations and Kinematics Chap, g 


8.3.3. The first column corresponds to the direction vector for the x ay 


wae? a, & aXis of 
frame 2. Since the x axis of frame 1 points in the opposite direction from 
the x axis of frame 2, the first column of the transformation matrix is 
n, <=] 
n,| 0) 
A. 7 0 (8.3.2) 
0 0 


The second column corresponds to the y axis of frame 2. From Figure 8.3.1 


we note that the z axis of 1 is parallel to the y axis Of 2. Thus the second 
entry is 


* 


0 0 


The third column, representing the direction of the z axis of frame 2, is set 


to indicate the direction of the y axis of 1. In this case they are parallel, 
Thus we obtain 


0 
0 
1 


So 8 9 
Nn < 


(8.3.3) 


(8.3.4) 


oF SF & 
| 


oor °o 


Finally, the fourth column is the distance of the origin of frame 2 from frame 
1, using 1’s origin as the point of reference. Thus 


Px 
Py 
Pz 
1 


Combining Eqs. (8.3.2) through (8.3.5) into the matrix defined by Eq. (8.3.1) 
yields the same transformation matrix shown in Table 8.3.1, namely: 


-1 0 0 


(8.3.5) 


RN <t K 


X 
y (8.3.6) 
Z 
1 


2 
oro 
oo fF 
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We will now introduce notation for a ho 
the coordinates of two frames m and n. 
of the form of Eq. (8.3.1), where n is the 
be referenced and m is the frame where t 


mogeneous transformation that relates 
The symbol 4A,,,, will represent matrices 
reference frame to which all points will 
he points or vectors are located. Thus 
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A,» relates points in frame 2 to frame 1. We may refer to Eq. (8.3.6) of Example 
12 
8.3.1 as 


-1 9g O x 


_ 0 0 Ll sy es 
A\z = 010% (8.3.7) 


0 0 0 1 


Assuming that we have applied Eq. (8.3.7) to some arbitrary vector u, we would 
now have u referenced to frame 1 (u’ = A,,u). To get u’ back to frame 2, the 
matrix operator Az, would be applied to u’ (u = A,,u'). The transformation A,, 
which maps points defined in frame 1 to the coordinates of frame 2 is the inverse 


of matrix Aj. From Figure 8.3.1 and the rules defining the entries of Eq. (8.3.1), 
transformation A,, 1S written as 


—-1] 0 O x 
_ 0 01 -z 

Ar, — 0 1 0 —y (8.3.8) 
0 0 0 1 


By comparing Eqs. (8.3.7) and (8.3.8), it seems that the rotation part of A,, 
and A,, is identical. It is important to understand that this is not generally true. 
In Section 8.4.1, we elaborate on the inverse of transformation matrices. 

It is possible to use the mechanics of the homogeneous transformation to 
work with multiple reference frames in space. Essentially, all that is necessary is 
to expand on the previous concepts and relate frames to one another via the Anm 
matrices. In addition, note that in relating one frame of reference to another. it 
is possible to introduce an intermediate one that is related to the others. This 
intermediate frame has no effect on the relationship between the Original frames 
and will not appear in the final result. To illustrate this, consider three frames in 
space 1, 2, and 3 and the associated A,,,, matrices relating them (Ais, Asx). Aj3 
can be generated by the relationship 


Aj3 = Ay X Ads (8.3.9) 


This result or “‘chain rule’? can be extended in general. Thus the final A matrix 
relating the first and last frames of a series of frames is given by 


Ain = Ay X Anz X Azg X +++ X Aw—2y(n-1) X Aw- pp (8.3.10) 


The following example illustrates multiple frames and the use of Eq. (8.3.10). 


EXAMPLE 8.3.2: MULTIPLE REFERENCE FRAMES IN SPACE 


Figure 8.3.2 shows four reference frames located in three-dimensional space. 
Such a configuration may arise by attaching frames to the individual links of 
a three axis robot or by assigning frames to interrelated objects. It is desired 
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Figure 8.3.2. Four reference frames in three-space. 


to find the transformation that relates points in each frame (6.54 1, 2, or 3) 
to the reference frame, 0. The following transformations are obtained by 


inspection: 
1 0 0 O 
0 0 1 O 
An=| 9 102 (8.3.11) 
0 0 0 1 
0 0 =—2) Q 
10 1 O O 
Ay = 1 0 0 9% (8.3.12) 
0 0 O 1 
0 10 ys, 
0 0 1 0 
= a 
0°0 0 1 


These matrices relate consecutively numbered frames to each other. It Is 
also possible to generate the transformations Ay), A,3, or Ao3 either by in- 
spection or by using the chain rule of Eq. (8.3.10). When done by inspection, 
one need only consider the two frames of interest, as any intermediate-num 
bered one would be absorbed as illustrated in the chain rule. 
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ating frames 1, 2, and 3 to the reference frame 
can be shown to be given by 


Eqs. (8.3.14) through (8.3.16): 


-1 0 0 0 
00 1 0 
An. = 
01 010, (8.3.14) 
000 1 
001 0 
_{1 00 y, 
Ay 0102 (8.3.15) 
000 1 
1 0 0 0 
_|9 1 0 (yi + y2) | 
Aw = | 4 04 , (8.3.16) 
0 0 0 1 


Example 8.3.2 illustrates the ability of the general transformation to reference 
points from one frame to another. In addition, it illustrates that we may relate 
points directly from frame to frame by ignoring intermediate ones and only using 
the spatial relationships between the two frames of interest. For illustrative pur- 
poses it is important to note that the axes between frames were related by multiples 
of 90°. However, if one can write the direction vectors of one frame by using the 


direction vectors of the preceding one, the inspection method also works extremely 
well. 


8.4 SOME PROPERTIES OF TRANSFORMATION MATRICES 


This section defines some additional properties of the transformation matrices. 


8.4.1 Formula for the Inverse of the Transformation Matrix 


In Section 8.3 we identified the inverse of a homogeneous transformation. 
Specificially, given a transformation A,,,, relating frame m to n, the transformation 
Ann telates points in frame n to frame m. A,,, is by definition the inverse of A 
Thus the inverse of a homogeneous transformation may be indicated by 


Ain) = Aim (8.4.1) 


Utilizing the notation of Eq. (8.3.1) for a homogeneous transformation con- 
sisting of column vectors, and standard matrix techniques, we can show that the 


reyes 
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inverse of the transformation A,,,,, is 
ne My, nN, —(pn) 
| O, O, O ~(p:o) 
-i — x b x 
(A jm) an. tf, a, nee (p-a) (8.4.2) 


0 OVO DU J 


Where p, n, 0, and a are the column vectors of Eq. (8.3.1). 
Since the product of any Square matrix and its inverse equals the identity 
matrix, 7, we have 


Aun, X Aan Hd (8.4.3) 


This relationship is easily verified by substituting Eqs. (8.3.1) and (8.4.2) into Eq. 
(8.4.3) and performing the multiplication. The known orthogonality relationships 
of the various vectors must also be used. 


8.4.2 Objects and Transformations 


An interesting application of homogeneous coordinates and transformations is in 
the field of graphics. The extension to robotics will become quite apparent throughout 
our discussion. The discussion in this section is a modification of that presented 
in [1]. | | 
Objects may be represented by a collection of vertex Points. These points 
are defined with respect to a reference frame affixed to the object. The relationship 
of the vertex points to the frame remains fixed once it is established. As an 
example, consider the wedge shown in Figure 8.4.1. As shown in Figure 8.4.1, 
the points (or vectors) describing the object are related to the orthogonal frame 
(x’, y’, z') by some fixed relationship. If the object is moved, the relationship 
between (x’, y’, z’) and the vertex points does not change (i.e., the object does 
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Figure 8.4.1. Wedge with reference 
frame affixed. 
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Figure 8.4.2. Wedge repositioned in 
space. 





not move with respect to its internal reference frame). Therefore, performing 
transformations on the reference frame of the object or to the points describing 
the vertices has the effect of moving the object about in space. 

Let us consider two operations on the wedge of Figure 8.4.1. The first 1S 
concerned with performing rotations necessary to stand the wedge on its wide end 
with the sloping part facing the reader. This can be accomplished by first rotating 
the wedge —90° about the y axis, followed by a rotation of 180° about the z axis. 
The results of these operations are shown in Figure 8.4.2. Note that the origin 
of the reference frame has not moved. 

The next step that we wish to perform is to move the wedge onto a table. 
Suppose that a translational transformation called ‘‘TABLE”’ relates points in the 
coordinate system attached to the wedge to a coordinate system located on the top 
of the table. Figure 8.4.3 shows the locations of the two reference frames. From 
this figure the transformation TABLE is defined as 


100 Ax 

{0 1 0 Ay 
TABLE=|,9 9 1 Az (8.4.4) 

00 0 1 


By premultiplying the repositioned vertex points (shown in Figure 8.4.2) by the 
transformation TABLE these vertex points are moved such that they will trace the 
Outline of the wedge on the reference frame attached to the table (see Figure 8.4.3). 
Obviously, the entire operation could be accomplished by multiplying the rotation 
and translation operators together in the appropriate order. 

In this discussion we introduced some of the concepts needed to describe 
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Figure 8.4.3. Wedge erected on table. 


tasks in a robot-independent environment. This type of description is sometimes 
called task description. 


8.4.3 Effects of Pre- and Postmultiplication of 
Transformations 


We shall now describe the effects of premultiplying and postmultiplying points in 
a given frame by homogeneous transformations. Let us begin with an arbitrary 
frame located in space, for example, frame 1. The transformation relating points 
in this frame to our base or reference frame (normally referred to as frame 0) is 
Ao,. In addition, we have shown that if we know the transformation (relating 4 
second frame, 2, to frame 1) Aj, then postmultiplying Ay, by Aj will relate points 
in the second frame to the base reference. 

If we now premultiply the transformation A,, by another transformation, 
effect is ‘moving the base reference frame” (i.e., we will now have the points in 
the coordinate system of frame 1 in terms of a new reference) Assuming that we 
wished to re-reference frame 1 to a different reference frame (e. g., frame 0’), We 


the 


sec. 8.4 — Some Properties of Transformation Matrices 
593 


would first generate the transformat; 
the original one, frame 0. Primate pa the new reference frame to 
4 x 4 transformation Ay, which would fee v1 DY Ag would then generate a 
stated previously, we can now completely dj points in frame | to frame 0’. As 
eae age pletely discard all references to frame 0). Thi 
articular relationship is extremely useful ; Me SEEM Sek Renn 
in ny setul in describing robot tasks independent of 
the actual working position and is Investigated in Sect p 9) 

The importance of this last concept is ; sap ing a ee 
pt is illustrated in the following discussion. 
Tasks to be performed by a robot can be described with respect . some fixed 
——, reference frame which we will call the base frame. If it is desired to 
perform the same task somewhere else in space, all that is needed is to find the 
transformation relating the new coordinate system to the coordinate system of the 
base frame. Premultiplying all the positions describing the point of the original 
task by this transformation permits the task to be performed with respect to the 
new coordinate system. Note that in theory, no reteaching or trimming of points 
is necessary since the original points have been transformed to the new frame. 
Once a series of points have been taught or computed with respect to some co- 
ordinate system, they may be transformed into a new coordinate system and their 
interrelationship will be preserved. 

Two special cases of the homogeneous transformation, simple rotations and 
translations, have been introduced in Sections 8.2.2.1 and 8.2.2.2. We will now 
discuss the effects of pre- and postmultiplying transformations relating frames by 
these operators. Recall the operations performed in Table 8.3.1 to align a movable 
coordinate system initially coincident with a fixed frame to a secondary frame 
displaced and oriented differently from the fixed frame. Operations of Rot (Z,, 
180), Rot (x,, —90), and Trans (X, Ya» Za) Were performed and always referenced 
to axes on the fixed reference frame. We may consider the fixed frame to be the 
identity matrix which represents a transformation that keeps points referenced to 
the same frame. This is premultiplied by Rot (z, 180), causing the points to be 
rotated about the z axis. The resulting points are then rotated — 90° about the x 
axis by premultiplying by Rot (x, —90). Finally, the points are translated by x,, 
y» Z, With respect to the reference frame by premultiplying by Trans (X., ae 
This example indicates that premultiplication of a transform representing the re- 
lationship between frames by a transformation representing a translation or rotation 
causes that translation or rotation to be made with respect to the base or reference 
coordinate frame. . a, 

In the case of postmultiplication, the rotation or translation is made with respect 
to the axes of the second frame. In other words, postmultiplying the transformation 
A,» by a rotation operator will perform the operation about the coordinate frame m, 


while premultiplying will perform the operation about the coordinate frame : 
It is important to visualize that chaining these operations changes the reference 


frames. That is, once a transformation is postmultiplied bya rotation or translation 
operator, we should think of that frame being transformed into age frame. 
Subsequent operations are NOW performed on this = sen ba ‘4 axes may 
bear no relationship to the directions of the axes of the origina 
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8.5 HOMOGENEOUS TRANSFORMATIONS AND THE 
MANIPULATOR 


Before describing the mechanics of obtaining the forward and inverse solutions of 
a robotic manipulator, we will utilize the properties of homogeneous coordinates 
and homogeneous transformations to aid in describing the position of the manip. 
ulator and to define concisely the mathematics required to define the positions of 
the manipulator in situations where they must be computed. ‘This approach was 
chosen since these concepts are independent of the robot configuration and serve 
to illustrate the power of describing the manipulator with homogeneous transfor- 
mations. In addition, they provide some insight into what type of computations 
and data manipulations must be performed in a robotic control system in order to 
define terminal and intermediate positions required for motion control. 


8.5.1 The Position of the Manipulator in Space 


The only concept lacking in our background of homogeneous coordinates and 
robotic manipulators is that of representing a point by a transformation. We will 
use the term point to describe the position of the manipulator with respect to a 
reference frame. This point is the ‘nformation that must be saved by the robot's 
controller for later use. By recalling these points and extracting the correct data 
for the servos, the manipulator can be ordered to go to various positions in space. 

The position of the manipulator will be defined as the position and orientation 
of its end effector or gripper with respect to a reference frame usually attached to 
the base of the manipulator. Homogeneous transformations will be used to define 
these data concisely. 

The term base or base reference will be used to define the frame to which the 
gripper is referenced. Sometimes it is convenient also to refer to this as the world 
frame. In our discussions, the terms base reference and world reference are usually 
interchangeable, and any exceptions will be noted. 

Recall that in Section 8.3 we defined the homogeneous transformation as 4 
4 x 4 matrix that could be used to relate points located in different coordinate 
systems. Its columns corresponded to the direction of the x, y, and z axes of one 
frame, written in terms of the x, y, and z direction vectors of another. In addition, 
the last column was the position of the origin of the first set of orthogonal axes 
with respect to the second. This concept may be utilized to describe the position 
of a robot. By attaching a reference frame to the end effector, a homogeneous 
transformation that relates this frame to a frame attached to the base of the robot 
arm may then be defined. This matrix, called the hand matrix, describes the 
position and orientation of the end effector with respect to the base reference ° 
the robot. Figure 8.5.1 shows a schematic of a parallel-jaw type of gripper wit 
a coordinate frame attached. 

The x, y, and z directions of the gripper are called the normal, orientation: 
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Figure 8.5.1. Schematic of gripper 
showing a reference frame with the tool 
point, approach, orientation, and nor- 
mal vector directions. 


and approach vectors, respectively—thus the reasoning for the symbols used in 
Eq. (8.3.1). The origin of the gripper’s frame is called the tool point and is usually 
positioned at some location in the jaws of the gripper. The location of the tool 
point defines the point on the manipulator that will be positioned at the coordinates 
defined by the fourth column of the transformation matrix. In addition, the axes 
of the coordinate frame will be aligned with the base frame as defined by the first 
three columns. For example, if the tool point is defined to be in the center of the 
gripper as shown in Figure 8.5.1, and Eq. (8.3.1) defines the gripper’s position and 
Orientation, the center of the gripper would be located at (p,, p,, p-). If the tool 
point was defined on the center of the backplate of the gripper, this ts the point 
that would be positioned at (p,, Py, Pz). Such a scheme is reterred to as tool point 
control. When controlling the position of a robot, for example, as in curve- 
following or straight-line motion, it is the tool point that is made to follow the 
desired path. By utilizing tool point control, we may align other frame origins 
with the physical location defined by this point. Additionally, the tool point can 
be moved mathematically to compensate for picking up objects of various heights 
Or to adjust for tool wear. . 

The symbol T is used to designate the hand matrix. This matrix is the product 
of multiple transformations which define frames relating the positions of the various 
parts of the manipulator to one another and to the base [see Eq. (8.3.10)]. By 
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this definition, T may also be thought of as Aon for a system with (n + 1) frames. 
Thus we may write 


HAND = T = Aon (8.5.1) 


For the sake of simplicity in the following sections, we will assume that our 
manipulator is ideal, that is, one that can be positioned (and oriented) anywhere 
within its workspace, so that, in effect, the robot workspace Is unbounded. In 
addition, we will assume that given any hand matrix representing its position, the 
robot will be able to achieve this desired configuration. For example, positionin 
its gripper in the center of one of its members, or moving through itself, will be 
permissible. Obviously, this is not always the case for real-world manipulators. 
The configuration, degrees of freedom, and mounting locations can vary greatly 
and therefore can limit the positions and orientations that the robot may achieve. 

It is important to note that a position and orientation defined by a homo- 
geneous transformation may be unattainable by a given manipulator. The ones 
always guaranteed to be achievable are those computed from the joint angles 
defining a known position and orientation of the manipulator. The results of 
matrix operations on the hand matrix may define positions and orientations that 
the manipulator cannot attain. Therefore, in utilizing the framework of transfor- 
mations in robotic control and task description, one must be aware of the physical 
limits of the manipulator and its workspace. 


8.5.2 Moving the Base of the Manipulator via 
Transformations 


In Section 8.4.5 the concept of premultiplication of a transformation matrix that 
represented a coordinate system by another homogeneous transformation was dis- 
cussed. The ability to re-reference the coordinate system in which a task was 
originally demonstrated or computed provides a means of minimizing the number 
of points that have to be retaught or recomputed in order to describe the same 
task in another location. ‘The following discussion illustrates this concept. 

Consider the top view of a workspace as shown in Figure 8.5.2. The base 
reference of the manipulator is at the origin of the x-y axes shown in the center 
of the Figure 8.5.2. The z axis (not shown) is directed out from the plane of the 
paper, with its direction being defined by the “right-hand rule.” Let us assume 
that the manipulator’s task consists of drawing the letter A in each of the six sectors 
shown. Additionally, the A is to be positioned on the various line segments, such 
as ac, as shown in the figure. 

For this example the tool consists of a spring-loaded pen, which is colineat 
with the robot’s approach vector. The tool point will be defined so that if the 
orientation and normal vectors are placed in a plane, there will be sufficient pressure 
for the pen to write. Note that with this definition, the pen will always be oriented 
so that it is perpendicular to the work surface. Also, it is assumed that sector 0 
will be the area in which the robotic task has initially been taught or where the 
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Figure 8.5.2. Task using a change in manipulator’s reference frame. 


locations of points a, b, c, d, and e defining the character are known. We would 
like an easy way to perform the task in the remaining five sectors without having 
to teach additional points (e.g., a’, b’, c', and d'). By using coordinate transfor- 
mations to find the points a1, b1, c!, and d' the task performed in sector 1 will be 
identical to that demonstrated in sector 0 since the relationship of the points will 
be preserved. It should be obvious that if the points were taught in each sector 
there might be discrepancies. Using transformation techniques to demonstrate 
the points Only one time and then transferring them to another location in space 
makes the relationship among the various points consistent (i.e., the distance from 
Point a to point b and so on). 

To get some idea of the complexity of the number of positions necessary to 
Perform the task, consider what must be done to draw a single letter. The points 
and operations are defined in Table 8.5.1. 

O repeat the same task in sector 1, all that is required is to transform points 
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TABLE 8.5.1 OPERATIONS REQUIRED TO DRAW THE LETTER A IN SECTOR 1 OF FIGURE 8.5.2 


- Initially, manipulator is positioned at some ‘‘reset” or “home” location. | | 

2. On receipt of a start signal, the robot moves the pen to a position located directly above point a, so that 
the pen is normal to the plane of the work surface but not touching it. . 

3. Robot moves its tool point down so that it is in the plane of the work surface. The pen is now Perpendicular 
to the work surface and touching point a. 

4. Robot moves pen in a straight line to b (still touching the work surface). 

5. Pen moves in a straight line to c. 

6. Pen is lifted off surface. 

7 

8 


—_ 


. Pen moves to a position above point d. 
. Pen moves down to touch surface at d. 
9. Pen moves in a straight line to e. 
10. Pen is lifted off surface 
11. Robot moves to the “reset” position (as in step 1). 
12. Robot waits for another command. 


(a, b, c, d, e) to (a', b}, c}, d, e'). This is easily accomplished by premultiplying 
all of the taught points (as outlined in Table 8.5.1) by the homogeneous transfor- 
mation, which rotates points 60° in the clockwise direction about the z axis of the 
base. The operator Rot (z, —60) [see Eq. (8.2.27)] performs this operation. 
Observe that the rotation is in the negative direction because the cross product of 
the two vectors, each drawn from the origin to a and a’, respectively, defines a 
new vector in the direction opposite to the z axis of the base. 

Once the operation in sector 1 is complete, the same transformation, Rot (z, 
— 60) is applied to the points a! through d’, transforming them into points a? through 
d*. Note that we could have gone directly from the positions defined in sector 0 
to the corresponding ones in sector 2 by rotating 120° clockwise. We may think 
of the operation just described as equivalent to physically rotating the base of the 
manipulator by 60° clockwise before performing the task Originally defined in sector 
0. However, physical motion was not necessary. 

It is interesting to note that besides rotating about the z axis of the base, we 
could have used transformations to compensate for position offsets. This situation 
could arise if the base of the robot was not coincident with the coordinate frame 
of the work surface. In the case where the z axis of the manipulator’s base is not 
perpendicular to the work surface, we could have compensated for this tilt by the 
application of an appropriate rotation matrix. 


8.5.3 Moving the Tool Position and Orientation 


In Section 8.4,3 we noted that the postmultiplication of a homogeneous transfor- 
mation representing a frame resulted in rotations and/or offsets with respect to the 
coordinate system of that frame. This concept provides a means of defining new 
too] positions and orientations based on the Current value of the hand matrix. 
Assume that we have defined the position and orientation of a manipulator 
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at some point in mig bya Suitable hand matrix. Further, suppose that it is desired 
to know the nce " ak of the intermediate positions that result if the tool is 
moved in a straight line along its approach vector. From the results of previous 
sections We know that postmultiplying the hand matrix by Trans(0), 0, dz) will move 
the origin of the tool point a distance dz from its current location. Repeated 

ostmultiplications of the current point by Trans(0, 0, dz) will produce points evenly 
spaced (i.e., equal increments of dz) along the direction of the tool's approach 
vector. From the resulting matrices, the intermediate positions along the straight- 
ine trajectory can be determined, 

Application of the operators Trans (dx 0, 0) and Trans (0, dy, 0) can be used 
to generate points along the straight-line paths parallel to the normal and orientation 
vectors of the tool reference frame. In the same fashion, one can define trans- 
formations such as Rot (z, 180), which will give the position of the manipulator 
that corresponds to a rotation of the gripper 180° about its approach vector. Trans- 
formations such as Rot (y, A) can be used to find the position of the gripper for 
‘acremental rotations about the orientation vector. The operations just described 
are associated with tool motions. 

It is often important for the gripper to move so that the tool point remains 
parallel to the robot’s reference axes (i.e., the world axes) while maintaining the 
orientation of the gripper during the motion. World motions are defined as mo- 
tions in which the tool point moves in a direction parallel to a defined world x, y, 
or z axis and maintains the orientation of its tool frame to this world frame. Points 
for these motions are generated by modifying the appropriate variable in the po- 
sition vector, that is, the fourth column of the hand matrix. For example, to move 
along a path parallel to the x axis of the world reference frame, the entry p, of 
Eq. (8.3.1) would be the only variable modified. 


EXAMPLE 8.5.1: OPERATIONS ON THE POSITION OF A MANIPULATOR 


It is desired to compute the value of the hand matrix, which defines the 
position of the manipulator displaced dz units along its approach vector, 
followed by a rotation of 180° about the same vector. This could correspond 
to the endpoint of a motion in which a robot moves a container forward (dz 
units) and then dumps out its contents by rotating the container 180°. 

The base of the manipulator and the position of its gripper are given 
by the same frames as shown in Figure 8.3.1. Frame 1 is the robot’s base 
or world frame, while frame 2 shows the position of its gripper. The trans- 
formation relating the gripper position and orientation to the base is 


(8.5.2) 
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Postmultiplication of Eq. (8.5.2) by Trans (0, 0, dz) results in the Matrix 


T= 


—-1 0 0 % 
00 1 (0 + dz) 
0 1 0 Z (8.5.3) 

0 1 


0 0 


From the geometry of Figure 8.3.1, we note that motion along the approach 
vector will result in an increase of the variable y since the tool z axis is paralle] 
to the y axis of the base or world frame. ‘This is also clearly seen in Eg 


(8.5.3). Postmultiplication of Eq. (8.5.3) by Rot (z, 180) yields the desire 
result: 


(8.5.4) 


oo°or 
| 


Example 8.5.1 demonstrated in a simple manner the power of postmultipli- 
cation. By using this technique it is possible to generate positions for motion or 
other points related to known positions but not explicitly taught. To illustrate 
this, consider the discussion of Section 8.5.2. Recall that to perform the desired 
task (i.e., drawing the letter ‘‘A’’) we also needed a point directly above the point 
a. If a had been explicitly taught, a point directly above it could have been 
computed using the techniques just discussed. 

Transformations can be used to compensate for differences between the lo- 
cation (and orientation) of the original tool (used to teach or demonstrate the 
program points) and the actual tool used for performing the task. Typically, robot 
programming languages provide for features called too/ transforms. Such trans- 
forms are a convenient method of compensating for wear or for using different 
grippers or tools. ‘Tool transforms make it possible to teach a task with one gripper 
and then perform the same task with a different one which may have longer jaws 
or be offset from its original mounting position on the robot. Postmultiplication 
of all the points of a given task by an appropriate transformation will provide the 
necessary compensation for the worn tool or new gripper. 

Another interesting application of postmultiplying the hand matrix by a trans- 
formation is to vary the relationship between an object and the tool point of the 
robot. Consider the task of stacking 1 in.-per-side blocks on a tabletop. A block 
is placed in the gripper and the robot is positioned so that the block is at the desired 
location at the bottom of the stack. The tool point will be some location above 
the table, since the block is assumed to protrude from the jaws. The hand matrix, 
T, corresponding to the bottom of the stack is recorded. To cause the manipulator 
to place the next block directly on top of the first, all that is 


required is to post- 
multiply 7 by the matrix Trans (0, 0, —1). 


This causes the tool point to stop | 
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‘nch above the point originally taught so that the robot can deposit the second 
block correctly. 


3.5.4 Relative Points and Reference Frames 


3.5.4.1 Reference frames 


Palletizing 1s a common application of robots whereby objects are placed into 
a two-dimensional array. A common example is placing soda bottles into a par- 
titioned cardboard carton similar to the discussion in Section 2.3. Depalletizing 
is the inverse process, concerned with unloading the regular array. Figure 8.5.3 
shows the schematic drawing of a pallet consisting of 12 locations. 

The pallet itself can be considered to have its own reference frame, as is 
shown in this figure. One corner is chosen as the origin with two perpendicular 
edges defining the x and y axes. The compartments or holes define the locations 
where objects are to be placed. The center of each hole may be defined with 
respect to the coordinate system affixed to the pallet. It is assumed that these 
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Figure 8.5.3. Pallet with frame and locations. 
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holes are evenly spaced in the x and y dimensions, and that their locations are 
fixed with respect to the coordinate system of the pallet. With the location of the 
first hole known, in terms of the pallet’s coordinate system, all other locations can 
be determined. 

Now consider placing the pallet into the workspace of a robot. Even if we 
know the spacing between the hole centers and the absolute location of the first hole 
in the coordinates of the pallet’s reference frame, we still do not have enough infor- 
mation to guide the robot to the pallet locations. Although it is known how to move 
the gripper, either with respect to the robot’s base or with respect to its tool axes, we 
cannot relate the robotic workspace to the coordinate frame of the pallet. We need 
the transformation that relates the base or world frame of the manipulator to the 
coordinate system of the pallet. Given this relationship, the gripper can be com- 
manded to go to the appropriate locations. 

Three possible methods of determining the transformation relating the two 
reference frames are outlined in the following discussion. The first approach simply 
consists of “teaching” the manipulator the first pallet point, P, of Figure 8.5.3. 
This information allows us to compute the location of the pallet’s frame with respect 
to that of the robot. Using the chain rule we obtain 


(8.5.5) 


i= A pase, pallet_frame 4 pallet_frame, first_pallet_point 


In Eq. (8.5.5), T, the hand matrix, relates the base reference of the robot to the 
tool frame, which has been positioned on the first pallet point and oriented in some 
known manner to the pallet’s reference frame. The second A matrix, relating the 
pallet frame to the first pallet point, can be found from the geometry of the pallet. 
The remaining A matrix is the desired result. Solving Eq. (8.5.5) for the rela- 
tionship between the manipulator’s base frame and the pallet’s frame yields 


(8.5.6) 


Although Eq. (8.5.6) yields the correct results, (i.e., is mathematically cor 
rect), physically, the alignment of the gripper with the first pallet point so that 
both position and orientation (to the pallet frame) are correct is a difficult task. 
The reason for this ranges from interferences between the gripper and pallet, to 
coarseness of the robot’s control resolution, to operator indifference, among others. 
It should be obvious that any small angular error may introduce gross errors 4° we 
try to compute the pallet bin’s locations farther from the pallet’s coordinate axes. 

A similar approach is to align the frame attached to the gripper SO that it 1s 
coincident with the frame of the pallet. This essentially makes the transformation 
defining the hand matrix (with respect to the reference frame of the robot) te 
same as the transformation relating the base of the robot to the frame of the pallet. 
Accomplishing this alignment may be difficult if the frame on the pallet and that 
of the gripper interfere mechanically. Additionally, both the frame of the grippe! 
and the frame of the pallet may not be well defined, and thus lining up the grippe! 
would be only an approximation. If the two coordinate frames are not perfectly 


A pase, pallet_frame = TA first_pallet_point,pallet_frame 
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aligned, the transformation matrix may describe a plane for the pallet which could 
be tilted in as many as three axes. 

A more reliable method does not rely on the frames of the pallet and tool. 
Instead, the robot is “shown” three points on the pallet, thus defining a plane. 
This will be referred to as a three-point alignment method. By showing the origin, 
and points on the x and y axes as far from the origin as possible, we can define 
vectors for the x and y axes of the pallet frame with respect to the base reference 
frame of the robot and thereby calculate the transformation relating the frames. 
Three points are necessary in that they also give information on the tilt of the 
frame if it is not flat on the work surface. The cross product of the x and y axes 
will define the normal to the pallet and the z axis of the frame. 

When teaching these points to the robot, we have the ability to define both 
their position and orientation. As mentioned before, since it may be quite difficult 
to show points with exact position and orientation, we utilize only position infor- 
mation. This is accomplished by moving the tool tip (or a known point on the 
gripper) to the points of interest. Note that the tool transform may be used to 
modify the offset if the tool point is not used to show the points. Then the last 
column of the hand matrix, T [Eq. (8.3.1)] contains the position of the point using 
the world coordinates. From the three points and the vector techniques of Section 
8.2.1, the desired transformation is computed. 

Once the frame transformation is defined, the only remaining concern Is to 
calculate the positions of the gripper that correspond to the holes in the carton. 
Clearly, both the location of the tool point and its orientation need to be defined. 
It is quite obvious that if the gripper had an object in its jaws, we would want the 
approach vector to point downward. This is necessary so that when the gripper 
is opened, the part falls into the partition. Additionally, let us assume that we 
want the parts placed in the box so that the orientation vector was parallel to the 
y axis of the pallet. 

To determine the hand matrix corresponding to each of the compartments in 
the box, one can make use of the translational and rotational transformations of 
Section 8.2.2. For each compartment of the box, one can define a transformation 
Ansilet frame-hole> HIS transformation has, as its first three columns, the identity 
matrix while the last column is the location of a particular hole with respect to the 
pallet’s reference frame. This is essentially Trans(a,b,c), where a and b are the 
spacing between holes and c is a value that makes the point some distance above 
the bottom of the box. Finally, if one postmultiplies this matrix by Rot(y,180), 
the resultant transformation will have the tool point located in the center of the 
hole with its orientation vector parallel to the y axis Of the pallet and its approach 
vector antiparallel to the z axis of the pallet (i.e. pointing downward). 

The computation of the hand matrix based on the discussion above is as 


follows: 
T a A pase. pallet_frame A pallet_frame, hole Rot(y,180) (8.5.7) 
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Equation (8.5.7) generates a hand matrix which is the product of the A matrix 
relating the base frame to the pallet, and the A matrix relating the origin of the 
pallet to a particular hole. The Rot matrix orients the gripper so that it Points 
downward while keeping the orientation vector of the gripper parallel to the y axis 
of the pallet. . . 
Although the preceding discussion may seem complicated, the benefits are 
quite useful. After the operations on the first pallet have been completed, it can 
be removed. Subsequent pallets do not have to be placed at exactly the same 
location in the workspace, since their location with respect to the base of the robot 
may be recomputed once the three-point alignment described above is performed. 


This approach eliminates the need for complex or expensive fixturing for parts 
presentation. 


8.5.4.2 Relative points 


The preceding discussion illustrates a problem and one possible solution in 
the application of using transformation techniques. Recall that we assumed that 
the locations were known in terms of the frame of the pallet. In the case where 
the task to be performed can be defined in a reference frame, but the locations 
must be “‘taught” (possibly due to irregularity), the use of relative points becomes 
attractive. 

Relative points are positions of the manipulator defined as offsets in both 
position and orientation from some frame. These points are saved (i.e., stored 
in the controller’s memory) as the homogeneous transformations which relate the 
point to a particular frame. Thus if the frame moves in space relative to, for 
example, the world reference frame, we can always find the coordinates of the 
point in question with respect to this reference frame. Equation (8.5.8) shows the 
relationship that would be used to accomplish such an Operation: 


T = ged denice Ph tetienaius (8.5.8) 

AS long aS Avorid frame iS defined, the hand matri 
multiplying the first transformation by siepainys 
orientation of the relative point to its reference c 
Fq. (8.5.8), relative points must always be referre 
Utilizing this concept in the previous palletizi 
pallet holes of Figure 8.5.3 would be defined with r 
That is, the relative point [form of EB 
the pallet frame. The pallet frame j 


x T can be computed by post- 
which relates the position and 
oordinate system. As seen by 
d to a frame. 

ng example, the locations of the 
espect to the frame of the pallet. 
q. (8.3.1)] Is written in terms of the axes ol 
3 . ‘ defined with respect to the world frame of 
the manipulator by using the three-point alignment method. The hand matrix, 7. 
used to position the gripper, is computed as in Eq. (8.5.8). Alternatively, if the 
actual relationship of each point with respect to the pallet’s frame is unknown but 
the transformation relating the pallet frame to the world frame can be defined, !t 
is possible to compute the relative Points. This is accomplished by moving the 
robot's gripper to the points of interest and then solving Eq. (8.5.8) for the trans- 
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formation, Agrame,point: Note that the data saved are not referenced to the base or 
~ world frame but are referenced to the relative frame. Thus to define the position 
of the gripper, we need two pieces of information: (1) the transformation relating 
the world frame to the reference frame, and (2) the transformation relating the 
reference frame to the relative point. If these relative points are then applied to 
another orientation of the frame, the end effector will move to the correct location. 

An extension of this concept is to chain relative points by defining relation- 
ships between objects or locations in terms of frames. This provides a dynamic 
relationship that will adjust to the environment provided that the correct reference 
frames are applied. In a real-world robot, relative points applied to frames other 
than those to which they were referenced may yield unattainable solutions. 

The following example illustrates the use of relative points and the three- 
point alignment method. 


EXAMPLE 8.5.2: FRAMES AND RELATIVE POINTS 


Figure 8.5.4 shows a two-dimensional workspace consisting of a base (or 
world) frame, a four-cell pallet A with cell center points (pi, P2, P3, Ps) and 
a second pallet, B, which is identical to A but located at another position in 
the workspace. The second pallet contains the points(p;, P>, P3> Pa)- 

It is desired to perform a task consisting of having the gripper transfer 
each object from pallet A to some processing station, such as a grinding 
operation, and then to move the finished part to the corresponding location 
on pallet B. We will assume that pallet A is fixed with respect to the world 


(Fixed) 





Base 
Reference 


Pallet B 
(Movable) 


Figure 8.5.4. Workspace of Example 8.5.2. 
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axes, while pallet B will be removed and replaced with an identical unit afte; 
the task has been performed. The points on the second pallet are not to be 
explicitly “taught” since the location of pallet B can change each time the 
task is performed. 

To accomplish the foregoing task, the procedure to be used will be to 
find a frame, frame A, to which points p; through p, can be referenced. Once 
this is done, relative transformations, which we will call LOC, through Loc, 
can be determined by the use of Eq. (8.5.8). Using the three-point alignment 
technique, a transformation relating the frame of pallet B to that of the world 
is defined and can be used with the transformations LOC, through LOC, to 
find points p{ through pj, located in pallet B. The steps are outlined below: 


. Manually move the manipulator’s gripper to points p; through p, and record 


the corresponding hand matrices. This is the tool point’s location and ori- 
entation with respect to the base reference frame. For each point, T of Eq. 
(8.5.8) is now defined. Let T,, designate the hand matrix for the demonstrated 


point n (nm = 1, 2, 3, 4). 


. Manually move the manipulator to points O,4, X4, and Y, on the first pallet 


and record the hand matrices corresponding to these points. This provides 
the data for the three-point alignment algorithm. 


. Compute the 4 x 4 transformation matrix representing frame A with respect 


to the world reference frame using the information in Table 8.5.2. This 
transformation will be designated by A,,,. The notation pX, means to use 
the vector p (p,, Py, Pz, 1)" of the transformation matrix for the computation 
(i.e., the fourth column of the hand matrix obtained in step 2 for the point 
X,). In addition, the function “mag” means to compute the magnitude of 
the vector. These steps define the four columns of the transformation matrix 
relating the world frame to the frame of pallet A. 


. Using the relationship given by Eq. (8.5.8), the values of LOC,, are computed. 


Thus 
LOC, = T,Az} = TAgy (8.5.9) 


We now have the value of the (relative) points that relate the positions of 
each of the cells of the pallet to the pallet’s coordinate frame. 


. Using the three-point alignment method, establish the transformation for 


TABLE 8.5.2 STEPS FOR FINDING A,,, 





1, x-direction vector: (pX, — pO,)/mag (pX, — pO 
2, y-direction vector: (pY, — nO Noiae 5 = ry 
3. z-direction vector; x x y 

4, Position vector: pO, 
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pallet B with respect to the world frame. This will be designated B,,,-. The 
procedure 1s similar to step 3, except that X,, Y,, and Op, are used. 
6. Compute points on pallet B using the relationship 


Ty = By LOC, (8.5.10) 


After this procedure has been followed, all the information necessary to 
position the manipulator at the points is available, and the task may be 
performed. Once pallet B has been used, it may be removed and another 
pallet moved into the workspace. Remember that the new location of the 
empty pallet can be anywhere and its orientation is also not critical. The 
entire task can be repeated by performing the three-point alignment to re- 
define the transformation B,,,,, and computing the appropriate values of 
T,,. Note that it is unnecessary to recompute LOC, through LOC,, since 
once established they remain constant. The transformation A,,,¢also remains 
unchanged unless pallet A is moved. 


——EE SS 


This example has shown how reference frames and relative points may be 
utilized to aid in defining a robotic task. Their ability to compensate automatically 
for changes in the location of objects within the workspace allows tasks to be done 
without the need for complex or costly fixturing to ensure the exact repeatable 
placement of an object, such as pallet B of the example. 


8.5.5 Vision and Reference Frames 


Most vision systems are two-dimensional in nature and look at a portion of the 
workspace of the manipulator. These systems usually give position information 
which defines the location of an object. This positional information is with respect 
to the reference frame established for the field of view. To use vision in a robotic 
System it is necessary to calibrate the camera’s frame of reference to that of the 
tobot so that the robot may move to the correct locations. The calibration or 
alignment is necessary since it may be difficult to guarantee the exact placement 
of the vision system’s frame of reference with respect to that of the base reference 
of the robot. 

Various procedures may be used to perform this calibration or alignment. 

hatever method is selected, it should be simple, repeatable, and perhaps require 
the use of no special fixtures. Of course, the nature of the problem will dictate 
other criteria or modify those mentioned. — 

From the previous discussions and examples in this section, it should be 
“vident that the procedure will generate a transformation relating the frame of the 
Vision system to the base reference of the robot. Thus using the properties of 
transformations (see Section 8.3), points in the frame of the vision system may be 
elated to the world frame of the manipulator. For this discussion the camera will 

© assumed to remain fixed in relationship to the world frame of the manipulator. 
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One possible method of calibrating the vision system's frame of reference to 
that of the manipulator is to have the manipulator position an object (that the 
vision system has been trained to recognize) in the field of view of the camera. 
The corresponding hand matrix will once again be called T. ZT may also be thought 
of as the transformation 


T = Ariane. object (8.5.11) 


Equation (8.5.11) relates the center of the top surface of the object (assuming that 
the tool point is at the center of the back wall of the gripper and the object js 
seated in the gripper) to the base reference of the robot. The robot is then 
instructed to release the object and move out of the vision system’s field of view. 
Next, the vision system is instructed to ‘‘find the object.’’ It reports back a trans- 
formation defined as follows: 


Aiden tame ,object (8 al. 12) 


where the coordinates given by the fourth column of Eq. (8.5.12) define the position 
of the object in the vision system’s field of view. It is extremely important to note 
that the position reported by the vision system (such as the centroid of the object) 
must be the same point defined by the hand matrix of the robot; otherwise, un- 
desirable offsets may occur. One simple method to ensure they are the same is 
to require that the object the robot places in the camera’s field of view has a 
marking (such as a solid circle) on its top surface. When the object is placed in 
the robot’s gripper, the center of the circle is aligned with the tool point either 
manually or by some other method such as self-centering jaws. 

We should note that, typically, vision systems only report x,y coordinates 
with respect to their frame of reference. Therefore, the pz entry of the fourth 
column can be set to zero and the first three columns of the transformation of Eq. 
(8.5.12) may be defined as the unit vectors in the x, y, and z directions (which are 
consistent with the coordinate system used by the vision system to define position). 
Vision systems typically use coordinate frames with the z axis going into the plane 
of the paper (see Chapter 6). 

For a two-dimensional imaging system, no z information exists if the vision 
system is looking at a part of the x-y plane of the base reference system. Note 
that it is possible to look at the y-z or z-y planes, and if this is the case, the algorithm 
must be adjusted accordingly. 

It is desired to extract a frame transformation from Eqs. (8.5.11) and (8.5.12) 
which will be a constant as long as the base of the manipulator and the vision 
system do not move in the workspace. The transformation that relates the bas¢ 
reference of the robot to the reference of the vision system is defined by the 
following relationship: 


T = Ampeonise — A vase vision_trame A vision_frame,object (8.5.13) 


= A b,vf Aveo 
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Using matrix techniques, the required frame transform 
This particular transformation IS a constant and ch 
the vision system in relation to the manipulator changes. If Aj, is applied to 
subsequent information from the vision system (of the form A,, at Eq. (8.5.13) 


may be used to compute the value of T, required to position the manipulator 
correctly. 


ation Aj, y, may be obtained. 
anges only if the mounting of 


3.5.6 Summary of What Transformations May Represent 


Table 8.5.3 summarizes various interpretations for the homogeneous transforma- 
tion matrix as discussed so far. It is important to remember that regardless of the 
interpretation, the form of the matrix, as given by Eq. (8.3.1), is the same. Thus 
it is impossible to determine what the matrix represents by just looking at its entries. 


Its actual use must be considered. Otherwise, one could confuse a relative point 
with an operator. 


TABLE 8.5.3 INTERPRETATIONS OF HOMOGENEOUS TRANSFORMATION MATRIX 


————ewjvs$09 see 


1. Rotation or translation of a vector with respect to a fixed reference frame (see Sections 8.2.2.1 
and 8.2.2.2) 


. Transformation of points from one frame of reference into another (see Section 8.3) 
. Representation of a reference frame in space (see Section 8.3) 
. Representation of the position of a manipulator in space (see Section 8.5) 


. Operator that can change the position and orientation of a manipulator (see Sections 8.5.2 and 
5.5:3) 


6. Representation of a point relative to a reference frame (see Section 8.5.4) 
re 
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8.6 THE FORWARD SOLUTION 


The forward or direct solution of a robotic manipulator maps the value of the joint 
vector [Eq. (8.1.1)] to the transformation matrix relating the gripper’s frame to 
the robot’s world reference frame. The values of the joint positions are the var- 
lables in the forward solution, while certain other parameters, such as the distance 
Ctween the axes of rotation, remain constant. Thus the forward solution will 
Produce a matrix of the form of Eq. (8.3.1), where the entries will be functions of 
the Joint variables and constants. The forward solution is essential in defining the 
‘nematic relationship of the manipulator. | 
Kinematics is defined as the study of motions ignoring such concepts as forces, 
‘orques, and inertias, The types of motions discussed in the examples of Section 
5.3 deal only with the position of the manipulator and do not take into account 
€ load it is carrying or the fact that the inertia, as seen by the joints, changes as 
© robot’s position varies. Consequently, these examples were kinematic in na- 
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e of the tool to the base of the robot is also 4 


ture. Similarly, relating the fram ni | 7 
y B dynamic quantities affecting the tool’s motion 


kinematic problem, since none of the 


are taken into consideration. . d definiti h 
The following sections define the terminology and definitions that are useq 


in the Denavit—Hartenberg (D-H) representation of kinematic chains. This method 
uses matrices to describe the relationship among reference frames attached to 
various points on the manipulator. Once these matrices are defined, the chain 
rule [Eq. (8.3.10)] is used to find the relation between the base and tool frames. 


8.6.1 Background Information and Terminology 


A robotic manipulator consists of a sequence of rigid bodies called links which are 
connected to each other by joints. Together, the links and joints form a kinematic 
chain. The types of joints used in most manipulators are revolute (rotary) or 
prismatic (linear) and are driven by some type of actuator (see Chapter 4). Motion 
of a joint causes the link attached to move with respect to the link containing the 
joint’s actuator. The position of the joint may be obtained from a sensing device, 
such as an optical encoder (see Chapter 5), which monitors the position of the 
joint either directly or indirectly (e.g., by monitoring the drive motor's shaft po- 
sition). Figure 8.6.1 shows the links, joints, and actuators of a kinematic chain 
composed entirely of rotary joints. 

A serial link manipulator is one in which the links and joints are arranged in 
an alternating fashion, with the additional constraint that closed loops are not 
formed. Figure 8.6.la depicts a serial link kinematic chain, while Figure 8.6.2 
shows an example of a closed kinematic chain. In the latter figure, note that the 
linear motion of the prismatic joint causes link 1 to rotate about joint 1. For a 
serial chain, each link is connected to at most two others, and the joints and links 
are arranged to prevent the formation of closed loops. This is the form of most 
robotic manipulators and the one that will be considered in the following sections. 
In the case of manipulators composed of mechanical structures that form closed 
loops (such as the parallelogram configuration shown in Chapter 1), it is possible 
to use adaptations of the techniques discussed in this text to model these manip- 
ulators as a Serial chain. 

Each pair of joints and links constitutes a degree of freedom. Thus ina four 
degree-of-freedom manipulator we must be able to identify four links and four 
joints. The joints and links are numbered sequentially starting from the base, 
which is considered link 0) and is not counted in defining the degrees of freedom. 
The joint connecting the base to the tirst link in the serial chain is joint 1, while 
Sots th no flan eae st the ta of On tear he ee nee 
numbering of the joints and links f th a ee unk. —— 

whi pied Ae of the kinematic chain of Figure 8.6. 1a. 

gnilicance of links, from a kinematic pe 
a fixed relationship between the manipulator’s joint 
This relationship is used in assigning reference fra 


rspective, is that they mat 
S present at the end of the jink. 


mes to the manipulator. 
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Fixed \ \ End of Chain 


—_ Link 


Rotary 
Joint 


(a) 





Link n+1 
Link n ‘Transmission 
(gear box) 
(b) 


Figure 8.6.1. Joints, links, and actuators of a serial kinematic chain: (a) joints and links; 
(b) concept arrangement of actuators and links. 


_ Four parameters can be associated with every link of a manipulator. The 
tirst two, a; and a,, define the structure of the link, while the second two, d; and 
"> determine the position of the neighboring link. Each of these four parameters 
S defined With respect to the two joint axes attached to a particular link. Fora 
‘Srna joint, the axis is defined along the axis of rotation, with its positive direction 

“INg assigned in an arbitrary fashion. For a prismatic joint, the axis is defined 
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Figure 8.6.2. Closed kinematic chain. 


to be coincident with the direction of linear motion. 
direction is taken in the direction of increasing length. 


Figure 8.6.4 shows a;, the common normal distance between the joint axes 
at each end of link i and is di jOl 


Q, 
the angle between the two joint axes, is measured in a plane perpendicular to a 
It may be easier to visualize this angle by 

that it intersects joint axis (i + 1) and the 
dashed line in Figure 8.6.4. The angle i 


using a right-hand rule about q,. ’ 
twist of the link, respectively, define the Structure of the link. 

Figure 8.6.5 shows two links and three joints of a 
axis has two normals to it, one for each of the links it co 


In this case the positive 


drawing a line parallel to joint axis i so 
common normal. This is shown as the 
s measured from axis i to axis (i + 1) 
The parameters a; and a;, called the length and 


serial chain. Every joint 
nnects. Thus the axis of 


End of Chain 


(location of tool 
li cee mounting flange) 


\ tN N 
Jj 


-_ Ja Js 


Figure 8.6.3, Numbering of joints and links. 
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Line Parallel Saint oa 
Joint Axis i to Joint Axis i mn i 





Figure 8.6.4. Length and twist of a link. 


joint i has both a; and a;_, perpendicular to it. The relative position of the two 
links is given by d,, which is the distance between the two normals (a; and a;_) 
measured along the ith joint axis. 6; is the angle between these two normals 
measured in a plane perpendicular to the axis. The parameters d; and 0; are called 
the distance and angle between the links, respectively, and are used to define these 
relationships. 





& 
= 6 
=e 
ae) 
Joint (i+ 1) Joint (i-1) 
Axis Axis 


Figure 8.6.5. Distance and angle between links. 
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TABLE 8.6.1 RULES FOR ESTABLISHING LINK COORDINATE FRAMES 


LL  0—_ On EE 


1. The z,_, axis lies along the axis of motion of the ith joint. 
2. The x, axis is normal to the z,_, axis directed toward the z, axis. 


3. The y, axis is defined by the cross product of z; and x,;, so that the three axes form a 
right-handed system. 


a 


8.6.2 Establishing Link Coordinate Frames 


Based on our knowledge of homogeneous transformations, if reference frames are 
established on each link and then related to one another, the tool point or the 
frame at the outermost link can be described in terms of the coordinate system 
established at the base of the manipulator. Denavit and Hartenberg [13] developed 
this relationship in terms of the four link parameters just introduced in Section 
8.6.1 and the joint axes. 

To understand how this is done, it is first necessary to define each set of 
reference axes. The coordinate frames are established based on the rules shown 
in Table 8.6.1. Figure 8.6.6 shows the coordinate system along with links and 
joint axes. 

These rules are all that is necessary to establish coordinate frames on each 


link at its joint axis [5]. There is some implicit information generated by them, 
however, which will now be discussed. 


1. Since the x; axis is, by definition, perpendicular to the z; axis (rule 3), rule 2 


Zj 


Qi Joint i 





Link (i-1) 


4-2 
Xj 


yi 





aD 
{ / 
Vi-1 L-4 
Joint (i+ 1) i 
Joint (i+ 1) 
Axis Axis 


Figure 8.6.6, Link coordinate trames and joint parameters. 
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implies that the x; axis is along the common normal, a,. of the 
axes with its direction from the Z;_, to the z, axes. 7 

2. The origin of the ith coordinate frame (i.e. 
located at the intersection of the common n 
(i + 1) and the axis of joint (i + 1). 

3. The location of the origin of frame 0 may be chosen anywhere 
z axis lies along the axis of motion of the first joint. 

4. The last coordinate frame (attached to the tool or 
where in the hand as long as the x axis is 
linking the last frame to the manipulator. 


z,_, and z, 


. the frame attached to link £) is 
ormal of joint axis i and joint axis 


as long as the 


hand) can be placed any- 
normal to the z axis of the joint 


Although the rules of Table 8.6.1 define the assignment of coordinate frames, 
some of the most common joint configurations that occur in robotic m 


anipulators 
do not fit into this model. 


The following clarifies some common exceptions. 


1. Consecutive joint axes intersect. This configuration is probably the rule more 
than the exception. If two joints are arranged so that their joint axes intersect 
when extended, there can be no common normal connecting them. Thus 
the parameter a; is zero. In this case, the x, axis may be chosen along either 
of two opposite directions normal to both the z,_, and z, axes. The origin 


of the ith frame is then selected as the point of intersection of the two joint 
axes. 


2. Consecutive joint axes are collinear. Any direction normal to the z,;., aXis is 
a valid choice for the x; axis. The origin of the ith frame may be placed 
anywhere along the common joint axes. 


A careful examination of the rules presented above reveals that the assignment 
of reference frames is not necessarily unique. Typically, manipulators are designed 
So that some joint axes do intersect. The particular geometry of the manipulator 
and type of inverse solution sometimes dictate the best choice if an axis may be 
selected in more than one way. 


8.6.3 The Denavit— Hartenberg Matrix 


Once we have established the reference frames for the links at the joint axes, We can 
determine the four parameters, (a,, a, @, and 9;), describing each joint—link pair. 
“S¢ parameters are then used to define terms in a transformation matrix relating 
“onsecutive frames of the serial manipulator. This matrix will be called the Denavit— 
Hartenberg matrix to distinguish it from other forms of the transformation matrix, 
he D-H matrix is solely dependent on the four link parameters [8]. | | 

In the following discussion, a reference to an axis assumes reference to its 
Positive direction. Also it is assumed that one mentally extends axes to find their 
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TABLE 8.6.2 LINK PARAMETERS FROM LINK COORDINATE FRAMES 
SL ——————————— 

1. @;is the angle from the x,_, to the x; axis measured about the z;_, axis. This is defineg 
using a right-hand rule since both x;_, and x; are perpendicular to z;_,._ The direction 
of rotation is positive if the cross product of x;_, and x; defines the z,_, axis. @, is 
the joint variable if the joint i is revolute. In the case of a prismatic joint it js 4 
constant that may or may not equal zero. 

2. The distance between links, d,, is the distance from the x; to the x;,, axis measured 
along the z,_, axis. If the joint is prismatic, d; is the joint variable. In the case of 
a revolute joint, it is a constant that is not necessarily equal to zero. 

3. The common normal distance, a,, is the shortest distance between the Z;_, and Z; axes. 
It is measured as the distance along the direction of x; from the intersection Of 2}., 
and x; to the origin of the ith coordinate frame. For intersecting Joint axes the value 
of a; is zero. It has no meaning for prismatic joints and is set to zero in this case. 

4. The offset angle, «;, is measured from the z;_, to the z; axes about the x; axis, again 
using a right-hand rule. For most commercial manipulators the offset angles are 
multiples of 90°. 





points of intersection when necessary. With respect to Figure 8.6.6, the link 
parameters can be defined in terms of the link coordinate frames (see Table 8.6.2). 

With coordinate frames established at each link and the link parameters 
determined, the relationship between successive frames (1 — 1) and i can be de- 
termined by a series of translations and rotations similar to those defined in Section 
8.3 to derive the transformation matrix relating the coordinates of two frames in 
space. Our derivation and nomenclature are similar to [1], [6], and [8]. Referring 
to Figure 8.6.6, the operations in Table 8.6.3 will move the coordinate frame at 
joint (¢ — 1) to the frame at joint 7. 

The product of the elementary transformations defined in Table 8.6.3 when 
taken in order is the Denavit—Hartenberg matrix (D-H matrix). Equation (8.6.1) 
shows the product of these operators. 


Ag-1)i = Rot(x;, a;) Trans(a;, 0, 0) Trans(0, 0, d;) Rot(z,_j, 9,) (8.6.1) 


TABLE 8.6.3 TRANSFORMATION MATRICES TO RELATE SUCCESSIVE LINK 
COORDINATE FRAMES 
ee 
1. Rot (z;_,, 9;). Rotate by an angle 6, about Z;_,- This sets the x, and x,_, axes parallel 
to each other although they are not necessarily in the same plane. 


2. Trans (0, 0, d;). Translate the origin of frame (i — 1) a distance d,. This sets the * 
and x,;_, axes coincident. ‘ 


3. Trans (a;, 0, 0). Translate the origin of frame (i — 1) a distance a,._ This sets the 
origins of frame (i — 1) and i coincident. 
4. Rot (x, a,;). Rotate an angle a; about the x, axis. This sets the z. and z,_, axes (and, 
therefore, the y axis) coincident. 
en cate nn A ee 
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Evaluation of Eq. (8.6.1) using the link parameters as variables yields Eq: (8.6.2). 


cos 9; —COS a; sin 0, sina; sin 6; a; cos 0, 
deo” sin 0; COS a; COS 0, —sin a; cos 0; a; sin 0, (8.6.2) 
0 sin a; COS a; d, 
v 0 0 1 


Of the four parameters in the D-H matrix, a; and a, are constants while either 
d, or 9; is the joint variable. Revolute joints have variables in terms of 0, while 
terms that are functions of a;, a;, and d; are constants. In the case of a prismatic 
joint, a; is zero, 0; and a; are constants, and d; is the joint variable. Thus for the 
linear joint, all the entries of the D-H matrix, excluding d;, are zero or constants. 

The transformation matrix of Eq. (8.6.2) relates points defined in frame i to 
frame (i — 1). By defining the coordinate frames and determining the entries for 
the D-H matrices, we may determine the position of the tool or gripper (last link 
and frame) with respect to the base (0 link and joint 1) as a function of the joint 
variables. Recalling the previous definition of the hand matrix in Eq. (8.5.1), this 
matrix may now be defined by the successive frames established on each link of 
the manipulator. For an n-degree-of-freedom manipulator, the expression for the 
hand matrix is given by 


T = Ao, = ApiA12A23A34 °°" rot (8.6.3) 


Each of the A matrices in Eq. (8.6.3) will be of the form of Eq. (8.6.2). A 
particular A matrix will contain functions of the appropriate joint variable and 
some constants. The 7 matrix will be a function of all the joint variables. In 
later discussions it will be necessary to distinguish a T matrix that is a function of 
the joint variables from one which contains known entries. We will call the T 
matrix containing variables the symbolic T matrix and use the term numeric T 
matrix for the matrix that results when a symbolic T matrix is evaluated for a set 
of joint variables, or is defined in terms of known position and orientation vectors. 

Using the results above we are now in a position to generate the forward 
Solution. Table 8.6.4 summarizes the steps needed to do this. 


8.6.4 Comments on Forming the Forward Solution 


In applying the steps in Table 8.6.4 to determine the symbolic T matrix, it would 
€ advantageous to be able to check the intermediate results before doing the 


TABLE 8.6.4 STEPS TO OBTAIN MATRIX DEFINING FORWARD SOLUTION 


1. Establish coordinate systems for each link as outlined in Section 8.6.2. 

2. Determine the parameters a;, a;, d;, and 0; for each link as defined in Table 8.6.2. 

3. Evaluate the individual A matrices relating each successive link coordinate system as 
given by Eq. (8.6.2). 

4. Evaluate the symbolic T matrix as given by Eq. (8.6.3). 
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algebraic manipulations required to evaluate Eq. (8.6.3). Io accomplish this, we 
will draw on the results of Section 8.3 to evaluate the transformation matrix that 
relates two coordinate systems. 

Before assigning coordinate frames and determining the link parameters leaq- 
ing to the A and T matrices, it is suggested that one position the manipulator in a 
‘convenient configuration.” This configuration should be such that one can easily 
determine “numeric” entries of the hand matrix with respect to the manipulator’s 


world axes. Remember that the world z axis will be along the axis of motion of 


the first joint. 
Possible examples of the robot’s initial configuration include aligning the too] 


vectors (approach, normal, and orientation) to be parallel or antiparallel to the 
world axes, and positioning the tool point at a measurable or known location with 
respect to the world origin. The preferred initial positioning is to have the tool 
point at a position along either the x or y world axis at some height z. This type 
of alignment of the manipulator allows one to determine the hand matrix by in- 
spection. 

Once an initial orientation is chosen, an arrow diagram similar to those in 
Examples 8.6.1 and 8.6.2 is made. The steps of Table 8.6.4 are followed and the 
A matrices may be determined. Before computing the symbolic 7 matrix of Eq. 
(8.6.3), it is suggested that the numeric values of the A matrices be computed and 
then multiplied together in the appropriate order. The numeric 7 matrix (eval- 


uated from the A matrices) should be compared to the hand matrix obtained by 


inspection. If no errors exist in either procedure, the two matrices should be 


equal. 
Additional tests should be made by moving a joint or some combination of 


the joint’s known increments that cause the tool tip to move to other ‘“‘convenient 
locations.” A table of hand matrices versus joint variables may be obtained for 
these joint vectors. The numeric values of the A matrices for each of these joint 
vectors and the corresponding numeric T matrix is generated and compared to the 
hand matrix. One should verify the solution for combinations of joint variables 
that cause the rotary joints to span 360°. This ensures that the signs of the sine 
and cosine functions are exercised and that the signs and direction of rotation 
defined when the axes were assigned are consistent. 

Once we are Satisfied with the results of the preceding exercise, the symbolic 
T matrix is computed. The multiplication is easily checked by evaluating at 4 
known joint vector and comparing the result with a known corresponding hand 
matrix. 
When multiplying the symbolic A matrices together to obtain Eq. (8-6-3); !t 
is sometimes convenient to group the matrices in a particular order which generates 
intermediate results which may be used in one form of the inverse solution, 45 
discussed in Section 8.7.2. For a six-degree-of-freedom manipulator, the preferred 
intermediate matrices are defined in Table 8.6.5. In this table, the superscript 
preceding the T indicates that it transforms from frame 6 (assumed) to the number 
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TABLE 8.6.5 PREFERRED 
INTERMEDIATE A MATRIX PRODUCTS 
FOR FORMING THE SYMBOLIC 7 
MATRIX 





ot = As, 

'T = Ags °T = AgsAso 

°T = Ax *T = AgyAysAse 

°T = Az3°T = Az3AyAgsAse 

'T = Ay, *T = Ay2A23A x4 AysA so 

T = Ao 'T = AA 12A23A 34 A4sAs6 


designated by the superscript. For instance, the third entry of the table is the 
transformation relating the coordinate system of link 6 to that attached to link 3. 


8.6.5 Examples of the Forward Solution 


The following examples show two common robotic manipulators, possible coor- 
dinate axis assignments, and the corresponding A matrices. 


EXAMPLE 8.6.1: THE STANFORD ARM 


Figure 8.6.7 shows the Stanford arm and a corresponding arrow diagram [5]. 
This is a spherical coordinate, six-jointed manipulator consisting of five revolute 
and one prismatic joints. The first three joints are used to move the tool 
point to its desired position, while the last. three adjust the orientation of the 
end effector. A parallel-jaw gripper is attached to the tool plate and the 
origin of the coordinate frame attached to the gripper is offset along the tool 
z direction a distance d,, as shown in the figure. The last three joints, which 
orient the tool plate, and hence the end effector, can be thought to have 
frames whose origins are coincident (this concept is developed in Section 8.7). 

Note that the structure of the manipulator is such that offsets exist 
between the links. Specifically, the axis along the rotation of the first joint 
does not intersect the z axis corresponding to the linear motion of the prismatic 
joint (joint 3). This offset manifests itself in a nonzero d, term between 
frames 1 and 2. It should be noted that these offsets increase the compu- 
tational complexity in both the forward and inverse solutions. However, 
they may be unavoidable because of certain design constraints incurred when 
developing a real-world manipulator. 

Table 8.6.6 shows the link parameters for the manipulator, while Table 
8.6.7 shows the symbolic A matrices of the form of Eq. (8.6.2) evaluated for 
the known values of the link parameters. The joint variables are 0,, 02, d3, 
0,, 0;, and 0. Note that these appear as variables in the appropriate A 
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Figure 8.6.7. Coordinate frames for the Stanford arm. (Reproduced with the permission of 
SRI International, Menlo Park, CA.) 


matrix. It is important to understand that the parameters d,, d,, and d, are 
known lengths of the kinematic configuration and hence not joint variables. 

The configuration of this manipulator is such that ‘“‘consecutive”’ joint 
axes intersect or are collinear. Recall from Section 8.6.2 that this implies 
that x, could have been chosen in the opposite direction with equal validity. 


TABLE 8.6.6 LINK PARAMETERS 
FOR THE STANFORD ARM 








Joint 6; Q; a, d, 
1 —90 —90 0 d, 
2 —~90 90 0 d, 
3 NA 0 0 4d, 
4 0 —90 0 0 
2 0 90 0 0 
6 0 0 0 de 


ee ae 
NA, not applicable. 
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TABLE 8.6.7 SYMBOLIC A 
MATRICES FOR THE STANFORD 
MANIPULATOR OF FIGURE 8.6.7 


cos@, 0 —sin@, 0 
A sin@, 0 cos, 0 
01 


0 0 0 1 


01 0 0 
—-1 0 0 0 
As =] 9 01 d; 
0 0 0 1 
cos 6, 0 —sin@, O 
_ | sin 6, 0 cos 6, O 
Asa = 0 —1 0 0 
0 0 0 1 
cos 8, 0 sin@; 0 
_ |sin@; O —cos 05 0 
Aas = 0 1 0 0 
0 0 0 i} 
cos @, —sin®, 0 O 
sin 0, cos@, 0 0 
Ass= | 1 d, 
0 0 0 1 


Reproduced with the permission of SRI 
International, Menlo Park, CA. 


Referring to Table 8.6.6, the change of direction for x, would mean that y's 
direction must be adjusted to form a right-handed system. In addition, the 
values of 6, and a, both need to be redefined as +90 instead of — 90°, as 1s 


ies shown. 


Oe 
EXAMPLE 8.6.2: THE SIX-JOINT PUMA 
in Fi jointed spherical manipulator 
The Puma robot shown in Figure 8.6.8 is a jointed sp , 
having six revolute joints. The values of the link parameters are shown in 
Table 8.6.8. Table 8.6.9 shows the symbolic A matrices derived from these 
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Figure 8.6.8. Coordinate frames for the six-joint PUMA. (Reprinted courtesy of the Society 
of Manufacturing Engineers. Copyright © 1983, from the ROBOTS 7/13th ISIR Conference 
Proceedings. ) 


link parameters. The A matrices and directions of axes are as presented in 
[14]. | 

The reader should note that the base or world reference frame (i.e., 
the one fixed to link 0) was chosen above the mounting flange. An equally 
valid choice is any other location along the axis of rotation of the first joint. 
The d, term is zero since the zo and x, intersect at a common origin. The 
value of a, is nonzero since the axes of joints 2 and 3 do not intersect. Once 


TABLE 8.6.8 LINK PARAMETERS 
FOR THE SIX-JOINT PUMA 
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° 
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| me af 
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| 90 —90 0 0 
2 0 0 as ds 
3 90 90 0 0 
4 0 —90 0 d, 
5 () 90 0 0 
6 0 0) 0 d 
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The Inverse or Back Solution 


TABLE 8.6.9 SYMBOLIC A 
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MATRICES FOR 


THE SIX-JOINT PUMA OF FIGURE 8.6.8 


cos 0, () 


—sin 6, 0 
A. = | Sin 6 0 cosd, 0 
01 0 _ ‘ 0 () 
0 0 0 1 
cos @, —sin@, 0 a,cos@, 
A. sin 6, cos @, 0 asin 6, 
= 0 1 d, 
0 0 0 1 
cos 8, 0 sin @, 0 
An sin@, 0 -—cos@,; 0 
0 1 0 0 
0 0 0 1 
cos 0, O -—sin@, 0 
Awe sin 6, 0 cos 6, 0 
cade 0 | 0 ad 
0 0 0 1 
cos 6, O sin @;, 0 
4. = sin@; 0 -—cos@; 0 
— 0 1 0 0 
0 0 0 1 
cos 6, —sin®, 0 O 
_ | sin 6, cos 6, 0 O 
Ass =| 9 0 1 d, 
0 0 0 1 


Reprinted courtesy of the Society of Manufac- 
turing Engineers. Copyright © 1983, from the 
ROBOTS 7/13th ISIR Conference Proceedings. 


again observe that other locations of frames will generate equally valid so- 


a eee 
8.7 
THE INVERSE OR BACK SOLUTION 
The back, reverse, or inverse solution maps the position of the manipulator, rep- 


resented by a hand matrix [see Eqs. (8.3.1) and (8.5.1)] into the corresponding 
Joint vector [Eq. (8.1.1)]. Recall that the joint vector contains the values of the 
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rotary joints’ angles and the lengths of the prismatic joints. i. the location 
and orientation of the robot’s tool point are defined by the ang es (or lengths) of 
the joints, in order to command the gripper to achieve some position defined by 
a hand matrix a corresponding set of joint variables must be known. | 

Sections 8.5.2 and 8.5.3 illustrated that we can make modifications to the 
position of the manipulator using matrix operators. For example, if the hand 
matrix were premultiplied by some transformation (for the purpose of rotating the 
base of the manipulator), or if a tool transform postmultiplied the hand matrix 
(corresponding to the linear motion of the tool along one of its axes), the joint 
variables needed to position the manipulator so as to correspond to the new tool 
point and orientation need to be determined. The inverse solution will compute 
the appropriate joint variables needed to position the arm as defined by the new 
hand matrix. . 

The back solution algorithm is generally more difficult than the forward 
solution and may require insight into the geometry of the manipulator. Addi- 
tionally, the equations generated are nonlinear and may not possess obvious so- 
lutions. Typically, the more complex the kinematic chain, the more complex the 
reverse solution. Some of the ‘‘problems”’ with the reverse solution for a particular 
numeric hand matrix are as follows: 


1. No solution may be possible, due to limitations inherent in the manipulator 
(i.e., the rotation of a particular joint is limited). 


2. Multiple solutions are possible since the manipulator can be positioned at the 
same “point”’ by more than one joint vector. 


3. The complexity of the solution may make real-time computation difficult. 


We now discuss these difficulties. 


8.7.1 Problems of Obtaining an Inverse Solution 


In the real world, the differences between the confi 
limit the possible orientations that the tool tip may 


explicitly demonstrated on one type of manipulator may not be achievable by 4 
manipulator with a different kinematic configuration. In addition, the degrees of 
freedom greatly limit the ‘‘dexterity” of a Manipulator. To illustrate this, consider 
locking 6, of the Stanford manipulator (Figure 8.6.7). This change will reduce 
the number of degrees of freedom from six to five and limits the possible orien- 
tations that the coordinate axes attached to the tool point may take Although 
five degrees of freedom may be sufficient for certain tasks, the dexterity of the 
arm is now limited (i.e., it cannot achieve the same fined: of positions and 
orientations in space that the six-degree-of-freedom configuration a 

| Physical limitations dictated by the actual implementation of the kinematic 
chain may also reduce the number of positions and Orientations possible. For 
example, consider attempting to have the approach vector of is Shade arm 


gurations of manipulators may 
achieve. Therefore, positions 


Sec. 8.7 The Inverse or Back Solution 625 


pointing toward the origin of the base reference frame and parallel to the prismatic 
‘int. Since the ranges of motion of the various joints are determined by the 

articular implementation of the mechanics, it is impossible in a configuration such 
as the Stanford arm to have joint 5 with a range of 360°. These types of positioning 

roblems will be true of all real manipulators. Regardless of the configuration, 
the physical implementation will dictate the maximum ranges of motions of the 
joints and therefore limit the possible positions and orientations of the manipulator. 

Another real-world constraint is based on the resolution, repeatability, and 
accuracy of the joints. Chapter 3 deals with these definitions in detail. However, 
since in most typical control implementations where the working range of the joints 
‘s divided into discrete positions, the coarseness or resolution of the control system 
may not allow the manipulator to be positioned at exactly the desired position as 
would be determined by calculation. The magnitude of this positioning error is 
defined by the absolute accuracy of a given manipulator. 

Based on the previous discussions, it should be apparent that transformations 
applied to the matrix representing the position of a manipulator may result in new 
hand matrices that define positions and orientations impossible to attain. In de- 
signing the motion and position control software for a robot, it may be required 
to perform the reverse solution for each of the points the arm will be commanded 
to go to, or even along the entire set of points defining a desired trajectory of some 
particular motion (prior to moving the manipulator) to determine if the joint values 
are within their acceptable ranges. Heuristic approaches may be needed to ensure 
valid solutions or to force some predefined constraint in the event that an impossible 
solution occurs. 

In general, the reverse solution will always generate valid joint vectors if the 
hand matrices were computed from a valid joint vector: that is, the manipulator 
was physically moved to some position in space, its joint variables were obtained, 
and then the forward solution was applied. However, there is no guarantee that 
matrix operations performed on a hand matrix defined by a valid joint vector will 
produce a hand matrix that has a back solution with a valid joint vector. 

The problem of multiple solutions for a particular “point” stems from trig- 
onometric solutions that can yield two possible sets of angles describing a particular 
“point.” Referring again to the Stanford arm in Figure 8.6.7, the same point (tool 
position and orientation) shown could be achieved by rotating joints 4 and 6 each 
180° in opposite directions. 

Another illustration of multiple joint vectors that result in the same position 
and orientation of the tool would be to move joint 2 an angular distance of 180° 
and then swing the arm via joint | so that the same tool point is achieved. Any 
other joints could then be modified to attain the correct position and orientation. 
In fact, this last manipulation introduces the idea of “right” and “left-handed 
Ways of approaching a point, The configuration of Figure 8.6.7 could be considered 

right-handed” since joint 2 corresponds to a “shoulder.”” Rotating joint 2, 180° 
followed by a joint 1 rotation of 180° would correspond to a “‘left-handed”’ con- 
figuration, Other ideas, such as having the "elbow‘ of a manipulator (such as 
JOint 3 of Figure 8.6.8) “up” or “down,” can also be conceived. ‘These preferred 
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configurations can be used to resolve the joint vector ambiguity heuristically when 
multiple solutions are possible and force the manipulator to stay in a particular 
configuration to ensure smooth motion. 

The complexity and speed of computation requires a trade-off study when 
the reverse solution is being implemented. Items such as update rate and band- 
width requirements come into consideration (refer to Chapter 4). Compromises 
such as reducing the frequency content of the velocity profile at which the manip- 
ulator moves, or performing some type of interpolation in lieu of computing the 
reverse solution as often, may have to be considered and compared against cost 
and performance considerations in the actual implementation of the control system. 
Another possible compromise is to keep the sum of certain joint angles constant 
during a motion. Thus knowing the constant and assuming that one of the angles 
is found by a reverse solution algorithm, the other angle may be found by simple 
subtraction. 


8.7.2 Techniques for Obtaining the Inverse Solution 


There are numerous techniques and approaches to finding the inverse solution. 
The common attribute is that their difficulty increases with the complexity of the 
kinematic chain. The approaches may be applied individually or collectively to 
obtain the information required to specify the joint variables in terms of the entries 
of a hand matrix. Ultimately, we want an algorithm that works for any numeric 
hand matrix described in terms of a set of variables as given by Eq. (8.3.1). 

For this discussion we assume a six-degree-of-freedom manipulator configured 
so that the last three joints primarily control the wrist, and therefore the orientation 
of the gripper, while the first three joints are used to position the link to which 
the wrist is attached. Recall the first three joints and links are called the major 
linkages, while the last three joints are called the minor linkages. A description 
of four techniques for finding the back solution follows. 


8.7.2.1 Direct approach 


This method obtains the equations from the symbolic hand matrix. To use 
the method, one equates a T matrix containing variables representing the known 
elements of the hand matrix to the symbolic T matrix [Eq. (8.6.3)], as shown in 
Eq. (8.7.1). 


nX O, QA, DP, functions 

Ny Oy @y Py} _ of the joint (8.7.1) 
mz 0, a, p.| | ___\ variables i 
0 00 1 000 T 


It is possible, by equating corresponding elements in the two matrices, to solve for 
the joint angles or lengths (8, through 6,,) as a function of the variables (n,, Ny, Mz 
O,, Oy, Oz, Ay, Ay, 4.) representing the entries in the hand matrix. 
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Although this is the most obvious approach, a careful examination of a typical 
‘a matrix will show that this approach can generate a set of up to 12 equations 
which may be highly nonlinear. However, this method should not be dismissed 
for simple cases or for obtaining some of the joint variables. 


8.7.2.2 Geometric approach 


This technique determines the joint variables by making use of the geometric 
relationship between the various links and joints of a manipulator. Depending on 
the points of reference chosen, the solutions for the joint variables may generate 
results that have to be re-referenced (usually, by adding an offset angle or distance) 
SO that they correspond to the joint variables which are used to compute the hand 
matrix. 

To simplify the problem, the kinematic chain of the manipulator is separated 
into two parts. This is possible for most industrial robots. The first part (consisting 
of the first three joints or major linkages) positions a point on the manipulator 
(and ultimately its tool point), while the second part (consisting of the last three 
joints or minor linkages) determines the tool’s orientation. It is important to 
mention that there may be interaction between the major and minor linkages when 
positioning the tool point. In general, the first three joints will grossly position 
the tool point, while the last three joints will move its position (in a finer manner) 
and orient the tool coordinate frame. 

Figure 8.7.1 shows the vector construction used to separate the kinematic 
chain into the two parts. Vector P terminates at the tool point, vector R points 
to the origin of the frame attached to the last link of the major linkage, and vector 
S (coincident with the approach vector) is directed from the tip of vector R to the 
tip of vector P. 

As an aid in visualizing why the vector construction of Figure 8.7.1 is possible, 
the following model may prove helpful. Ifthe last three joints are all rotary and 
their joint axes intersect at a common point, we may take advantage of reducing 
the last three joints to a compound joint. It can be shown [5], [6] that the last 
three joints and links, which normally provide a roll—sweep-—roll action in posi- 
tioning the last frame, may be combined and modeled as a ball-and-socket joint 
attached to a link of length d,, which terminates in the gripper. Figure 8.7.2 [5] 
shows a six-joint manipulator and a representation which uses a ball-and-socket 
joint in place of the minor linkage. A ball-and-socket joint has three degrees of 
freedom, representing the joints of the wrist it is used to model. The frames 
attached to the joints forming the wrist are considered to be coincident and located 
in the center of the rotating ball. 

Referring again to Figure 8.7.1, it is an easy task to evaluate the coordinates 
of the three vectors (P, R, and S). The coordinates of vector P are known from 
the hand matrix, since the coordinates of the tool point are the fourth column of 
the hand matrix. Note that S is directed along the approach vector, whose direction 
is completely defined by the third column of the hand matrix and whose magnitude 

(or length) is defined by the distance from the origin of link 3 to the tool point (a 
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Frame 3 Last Link 
Before Joints That 
Orient Tool 


Base 
Coordinate 
System Yo P=R+S 





Xo 


Figure 8.7.1. Geometric approach for the inverse solution using vector relation- 
ships. 


known parameter of the kinematic chain). Knowledge of both P and S (obtained 
directly from the hand matrix) permit calculation of R by subtraction. This vector 
represents the location from the base reference frame to the last link before the 
joints and links that orient the tool. 

Once vector R is determined, the values of the first three joint variables may 
be found using known parameters of the manipulator and geometric techniques. 
Reference [7] tabulates all the geometric solutions for permutations of rotary and 
prismatic joints in various configurations for the major linkages. The same ap- 
proach can be used to solve for the last three joint variables with respect to the 
frame at the end of link 3 (see Figure 8.7.1). . 

Once a geometric solution for the arm has been obtained, it should be tested 
against the forward solution to ensure that the joint variables are proper! referenced. 

Reference [15] provides a detailed geometric approach to findin; the inverse 
solution of a PUMA robot. It is noteworthy to mention that this auch makes 
use of arm configuration data [i.e., the preferred Orientation of the arm (left or 
right), the elbow (above or below the arm), and the wrist (up or down)] to resolve 
multiple solutions. 


8.7.2.3 Geometric approach with coordinate transformation 


| A modification of the geometric approach involves Separating the kinematic 
chain as described previously and then using the A matrices of the forward solution. 





(a) 


Ball and Socket 
Joint 





(b) 


Figure 8.7.2. Manipulator modeled with ball and socket joint: (a) six-joint ma- 
nipulator R-R-P-R-R-R; (b) equivalent four-joint manipulator R-R-P ball. (Re- 
produced with the permission of SRI International, Menlo Park, CA.) 
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Vector R defines numeric values for the last column of the D-H matrix A),; the 
three resulting equations may be solved for the first three joint variables. These 
variables may then be substituted into the first three columns of Ao; to define the 
position and orientation of the frame attached to link 3. After a numerical value 
for Ao; is obtained, using the chain rule and the value of the hand matrix, the value 
of A3. can be found using the relationship given in Eq. (8.7.2). 


F iuineite - Phe naite = Ah soneeta 7 oe (8.7.2) 


By equating the numeric value of A, to its symbolic representation, we may obtain 
equations for the last three joint variables. 

An alternative approach for determining the joint variables of the minor 
linkages is to use vector techniques. The vectors (normal, orientation, and ap- 
proach) of the hand matrix and A,, numeric matrix may be used to determine the 
angles of the joints corresponding to the minor linkages. The angles between axes 
corresponding to the coordinate system attached to the end of the major linkages 
and the approach, normal, and orientation vectors associated with the gripper (or 
link 6) are used to determine the variables for the last three joints. 


8.7.2.4 Manipulations of symbolic 7 and A matrices 


This method [1] makes use of the symbolic JT matrices, as shown in Table 
8.6.5. It is the most general technique in that no geometric insight is needed and 
it uses the forward solution as the basis of all back-solution algorithms. The 
procedure for using this approach is defined as follows: 


1. Equate a 7 matrix containing variables for all of its entries to the symbolic 
T matrix [Eq. (8.6.3)], which is the product of the A matrices relating suc- 
cessive frames to one another, i.e., 


d vestnbie = Pgcrialic = Aoe (8.7.3) 


2. Look for equations (which are obtained by equating elements of the two 
matrices) that are functions of only one joint variable. Use any information 
present to evaluate expressions or make substitutions for variables. Typical 
expressions obtained may contain transcendental functions of only one joint 
variable in terms of variables associated with hand matrix entries. 


3. To reduce the complexity of the terms on the right-hand side of Eq. (8.7.3): 
premultiply the variable T matrix by the inverse of the appropriate A matrices 
and equate to the corresponding "T matrix. For example, premultiplying by 
the inverse of Ap, gives 


A ol variable = ei = A j2Ar3AwyAysA se (8.7.4) 


At this point the left side of Eq. (8.7.4) contains the variables corre- 
sponding to the variable T matrix and functions (usually transcendental) of 
the first joint variable. If the first joint variable was previously defined, the 
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left-hand side of Eq. (8.7.4) isknown. The right-hand side contains equations 
which are functions of the remaining joint variables (65, 03, 04, 95, and 9g). 
By equating corresponding terms, it may be possible to find equations that 
have constants on the right side or may be expressed in terms of known 
quantities. 

Once a solution is obtained for a joint variable, it may now be used to 
solve for the others. For example, assuming that we found the first joint 
variable, we now look for terms on the right-hand side of Eq. (8.7.4) that 
are functions of another joint variable. Typically, we are interested only in 
those expressions which are functions of a single joint variable and possibly 
some constants. Since the left-hand side is fully defined, an expression for 
the joint variable on the right can be expressed in terms of those quantities. 
Once all the information in this first equation is exhausted, the equation’s 
complexity is again reduced, as described in the step below. 


4. The “unknown variable elimination” process is carried on by premultiplying 
both sides of Eq. (8.7.4) by the inverse of Aj, yielding 


Ax Aol variable = °*T= A734 34A45A 56 (8.7.5) 


Since previous manipulations determined the value of joint variable 0,, the 
left-hand side is now only a function of joint variable 05, while the right-hand 
side of Eq. (8.7.5) contains the remaining unknown joint variables. The 
process of equating corresponding entries is repeated to try to eliminate the 
second joint variable. 

5. The process is continued as far as necessary using information from each step 
to simplify as many entries as possible until all unknown joint variables are 


found. 


It should be noted that the equations may not simplify as easily as one would 
hope, and the method above may generate intermediate equations such as Eq. 
(8.7.5), which yield no simplifying information. If this occurs, it is necessary to 
premultiply by the next corresponding inverse of the A matrix until simpler expres- 
sions are generated. 

The techniques discussed are not foolproof. However, they do provide a 
Starting point for determining the back solution. A combination of the geometric 
approach for the major linkages and the matrix technique (discussed last) seems 
to provide a good balance. It should be noted that once a back solution algorithm 
is developed, one would like to optimize it (with respect to minimum computational 
time or effort) if it is to be used in a real-time control application. 


8.7.3 Some Comments on Solution Methods 


ed in kinematic chains are not limited to one or 


Typically, the angles encounter na : ‘im 
for an unknown joint variable it is necessary to 


two quadrants. When solving 
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SIN @ 
degrees 





COS 6 


360 degrees 


Figure 8.7.3. Sine and cosine curves. 


define the quadrant of the angle correctly with respect to the positive x axis. 
Examination of the sine and cosine curves shown in Figure 8.7.3 reveals that over 
the interval from 0 to 360°, there is not a unique mapping of the independent 
variable to the dependent variable. Therefore, using the arcsine or arccosine 
function alone will not correctly define the angle. Similar problems also exist with 
the tangent function. The arctangent of (y/x) and (—y/—x) produces the same 
angle since both ratios are positive. Similarly, the ratios (— y/x) and (y/—x) both 
generate the same angle. 

One way to overcome this ambiguity is to use information from both the sine 
and cosine since the arccosine uniquely maps the range (1 to —1) into (0 to 180°) 


and the sine is always greater than or equal to zero over this range. The following 
algorithm will uniquely define the angle: 


Algorithm that determines the correct quadrant of an angle given the sine and 
cosine of the angle 


Given the values of sin 8 and cos 0 


Qcandidate = arccosine[cos 6] 


IF sin8 =0 
9 = 360 — O candidate 
ELSE 
8 = @ 


Candidate: 
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The function ATAN2 usually available in most math packages performs this func- 
Hon, returning the values of the angle in the r ange (— 180 = @ = 180). This function 


takes into account quadrant information defined by the signs of its arguments. 
ATANZ2 is a double-argument function defined as 


9 = ATAN2 (y, x) 
9 = ATAN2 (sin 6, cos 0) 


When obtaining expressions for an unknown 
obtain expressions for both the sine and cogj 
expressions can then be used in the ATAN?2 fu 

Another important point to remember j 
solutions that contain division by transcende 
or negative numbers under radicals. 


(8.7.6) 
(8.7.7) 


joint variable it is usually easy to 
ne of the unknown angle. These 
nctions to define the angle uniquely. 
s that care must be taken in defining 
ntal terms that can be equal to zero 


8.7.4 Forward and Inverse Solutions of a Three-Axis 
Manipulator 


The following example will illustrate the concepts just described without the need 
to resort to cumbersome mathematics. For solutions of some common and more 
complex manipulators, the reader is referred to [1], [2], [5], [7], [8], and [15]. 


EXAMPLE 8.7.1: FORWARD AND INVERSE SOLUTION OF A SIMPLE 
MANIPULATOR 


Figure 8.7.4 shows the side view of a simple three-axis manipulator. The 
configuration is essentially that of a cylindrical coordinate robot. The ad- 
dition of the third axis ensures that the orientation of the part at deposit may 
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Figure 8.7.4. Three-axis manipulator. 
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Figure 8.7.5. Coordinate frames for the three-axis manipulator of Figure 8.7.4. 


be made the same as it was at pickup. With this configuration and the addition 
of an axis for vertical motion, the robot could pick up an object in its work- 
space and place it at another location with the same orientation that it org- 
inally had with respect to the base reference frame (see Chapter 9 for a detailed 
application). Note that this is being done in planes parallel to the x-y plane 
of the base reference axes. 

Figure 8.7.5 shows the assignment of coordinate frames to each link. 
It is important to take note of the position of the angles and their direction 
of positive rotation. These are defined when the frames are attached to each 
link by the rules given in Section 8.6.2. For the prismatic joint of the ma 
nipulator shown in Figure 8.7.4, it is physically impossible for the link pe 
rameter, d, to be equal to zero. Referring to the figure, a value of d = 
corresponds to the approach vector of the gripper being coincident with Zo: 
In reality, d takes on a minimum value corresponding to the fully retracté 
case and a maximum value corresponding to the fully extended cas¢. 
reader should recall that during calibration (see Chapter 5) the internal 
registers representing the value of the joint variables are set to appropriat® 
values corresponding to some predefined and reproducibl oa] reference: 
In this particular case, the maximum or mini aera her logica 
choice for the prismatic axis. Table 8.7.1 ae value of d would bea nile 

-7.1 defines the link parameters; w 
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TABLE 8.7.1 LINK 


PARAMETERS FOR THREE-AXIS 
MANIPULATOR 





Link 0; d, a, OL; 


1 0, d, 0 90 
2 0 R 0 90 
3 0; To 0 0 


Table 8.7.2 defines the A matrices. Multiplication of the A matrices generates 
the 7 matrices shown in Table 8.7.3. 

At this point we will investigate the relationship of the joint variables 
of the forward solution to the base reference frame. 

Figure 8.7.6 shows an overhead view of the manipulator base super- 
imposed on the x and y axes. For the case shown, the joint variables are: 
@, = 180° and 6; = 0°. The R axis and the gripper's y axis are parallel to 
the y axis of the base reference frame. The corresponding T matrix evaluated 
at these joint variables is given by Eq. (8.7.9). 


-10 0 0 
01 O R 

T=) 9 0 -1 (a — T) 8:72) 
00 0 


Note that if the zero reference for the joint variables is not convenient, 
it can be set to any arbitrary reference as long as the value used in the forward 


TABLE 8.7.2. A MATRICES FOR THREE-AXIS 
MANIPULATOR 


cos 8, 0 sin @, 0 
A. = sin@, 0 -—cos®@, O 
oe” 0 1 0 d, 
0 0 0 1 
1 O 0 O 
_10 0 —-1 O 
4n=19 1 OR 
0 0 0 1 
cos@, —sin@,; O O 
A= sin 6, cos 6, 0 O 
y 0 0 1 sen 
0 0 0 1 


nl 
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TABLE 8.7.3. 7 MATRICES 


cos@, -—sin@,; 0 QO 
°T = Ay = — ey 0; , : 
0 0 0 1 
cos 8, —sin 0, 0 0 
1 _ _ 0 0 = 1 = Tp 
P= ApAr sin@, cos@;, 0 R 
0 0 0 1 
cos@, cos@; + sin6, siné, — sin@, cos®, — cos@, sind, 0 R sin8, 
T = sin, cos6, — cos@, sind, —sin@, sind, — cos®, cosé; 9 —Rcosd, 
0 0 | (d, — T)) 
0 0 0 1 


(8.7.8) 





solution is corrected to be consistent with the coordinate frames and link 
parameters chosen. 

The back solution for this example wili be obtained in two ways. The 
first corresponds to Section 8.7.2.1, the direct approach of equating a numeric 
T matrix to the symbolic T matrix [Eq. (8.7.8)]. The necessary equations 
for the back solution algorithm are obtained by manipulation of terms con- 
taining joint variables until they are simplified. The second approach utilizes 
the method of Section 8.7.2.4, manipulations of symbolic T and A matrices, 
to find the joint variables. 


Yo 


Manipulator ————> 


Base Reference Frame 


Figure 8.7.6. Base coordinate frame 
and manipulator of Figure 8.7.4. 
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Method 1: Back solution by direct approach. Before attempting the back 
solution, the problem is simplified by reducing the general expression of the numeric 
T matrix so that its entries contain variables corresponding only to terms affected 
by the joint variables. Since certain entries of the symbolic T matrix are constant, 
the numeric 7’ matrix will be represented as 


ie Ox 0 Px 
t corieti = My Oy ? Py 
0 0 0 1 


Equating corresponding elements in the matrices given in Eqs. (8.7.8) and (8.7.10), 
we obtain six equations in three unknowns (R, 6,, and 63). Since the normal and 
orientation vectors are by definition orthogonal to one another, we could eliminate 
two of the equations. That is, given n, and n, we know o, and o,, and vice versa. 
This leaves us with four equations in three unknowns which are nonlinear functions 
of the joint variables. From previous discussions recall that a solution of one of 
the equations in terms of only sines or cosines does not yield sufficient information 
to determine the angle uniquely. Therefore, it is necessary to obtain an expression 
for both the sine and cosine of a particular rotary joint variable to determine its 
angle correctly. The procedure used follows. 

The equations corresponding to the p, and p, entries of Eqs. (8.7.10) and 
(8.7.8) are 


Pp, = Rsin 0, (8.7.11) 


Py = —K cos 0; (8.7.12) 


Noting that p, is proportional to sin 6, by the factor R and that p, is proportional 
to cos 6, by the factor — R, dividing both sides of each equation by the appropriate 
factor yields the sine or cosine of joint variable 6,. §, is determined by the double- 
argument arctangent function with p,/R and — p,/R as its argument. Since the 
factor R is removed when the tangent is defined, it may be dropped and the 
expression for 6, becomes 


9, = ATAN2 (p,, —Py) (8.7.13) 


If it had been possible for joint variable R to take on the value zero, this approach 
Would not have been applicable and an alternative would have been necessary. 
However, as discussed previously, this is physically impossible for this manipulator. 

The value of R is readily obtained by squaring the expressions for p, and p, 
and taking the square root of the sum. | 


R = Vp2 + p} (8.7.14) 


Once we have 0, and R or expressions for them in terms of the values assigned 
to the numeric T matrix, the solution for @, proceeds as follows. Selecting the 
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symbolic expressions corresponding to n, and n,, we obtain the following pair of 
equations: 


cos 0, cos 6, + sin 6, sin 03 (8.7.15) 


ny, 


ny = sin 0; cos 8; — cos 0; sin 0; (8.7.16) 


Substituting the expressions for cos @, and sin 0, yields the following two equations 
in two unknowns (sin 6, and cos @3) : 








Rn, = —p, cos 03 + p, Sin 03 (8.7.17) 
Rn, = p, cos 03; + py sin 93 (8.7.18) 
Solving for the unknown transcendental functions of 63; gives 
—Pyn, ~ Pxtt 
cos 03 = —— : = (8.7.19) 
P»N, ~ Pyn 

sin 0; = —~ + o (8.7.20) 

The value of 0; is obtained by using the double-argument arctangent function. 
63 = ATANZ2 (sin 83, COS 03) (8.7.21) 


6; = ATAN2 ((p,.n, + Diy). (pxNy _ Pynx)) 


Note that in Eq. (8.7.21) the variable R was dropped from the expression. 

Thus given any numeric T matrix of the form of Eq. (8.7.10) and any known 
constants of the system, the joint variables @,, R, and 03, can be found by the 
algorithm consisting of Eqs. (8.7.13), (8.7.14), and (8.7.21). 


Method 2: Solution by matrix manipulation method.- To illustrate this ap- 
proach, let us once again equate the symbolic T matrix [Eq. (8.7.8)] to the numeric 
T matrix. This yields the following matrix equation: 


nN, O, O Px 
n, 0, OY Py 
0 O —-1 (d, = To) 
0 0 0 1 
cos 8, cos 8; + sin 8, sin 6; sin 8, cos @; — cos 6, sin @, 0 Rsin 0, 
_ | sin@,cos6, — cos@,sin8; —sin6,sin 6; — cos 6, cos 6; 0 —Rcos®, 
° 0 0 1 


(8.7.22) 


We wish to reduce the complexity of this equation by essentially removing all 
references to a particular joint variable from the right side by moving it to the left 
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side. Premultiplying both sides of Eq. (8.7.22) by Ag! (or Ajo) will yield the new 


equation: 
cos 0, 1, + sin 8, n, cos 0,0, + sin®,0, 0 cos 0, p, + sin 8, py 
, 0 at mee 
sin 0, WN, — COS On, sin 0, 0, — cos 8, Oy, O sin 0, p, — cos 9; Pp, 
0 0 J 
cos 0, —sin 0, 0 0 
_ Ns = 0 0 — |] = To 
sin 6 cos 6, 0 R 
0 0 0 ] 


(8.7.23) 


The equation defined by entry (1, 4) is chosen since the expression generated has 
a zero on the right side and the left-hand side is in terms of only one joint variable, 
6,. This equation can be manipulated to obtain 

sin 0, — Px 


t = = .7.24 
an 0, 8 6, = (8.7.24) 








Equation (8.7.24) and the quadrant information defined by the values of p, and 
py in the numeric T matrix are sufficient to define completely variable 0, (this is 
the same information as yielded by ATAN2). Another possible approach for the 
solution of 0, is to use both the entries (1, 4) and (3, 4). Since R is nonzero, one 
may generate the matrix equation 


cos 8,} _|Px —py| | 9 76 
co e) hs P| E (8.7.25) 
(pe + Py 


Equation (8.7.25) yields solutions for both the sine and cosine of 6, in terms of p,, 
Py, and R. As in the generation of Eq. (8.7.13), the same argument may be used 
to remove R from the equations and obtain 9). 

_ With 6, defined, entry (3, 4) of Eq. (8.7.23) may be used to solve for R, 
yielding the expression 


R = sin 0; p, — cos ® p, (8.7.26) 


The final joint variable, 03, is obtained by using entries (1, 1) and (3, 1) or 
ae (1, 2) and (3, 2) to define the sine and cosine of this angle. 


The methods of Section 8.7.2.4 becomes quite helpful in the case of more 
Complex symbolic T matrices. Its use in this simple example was intended to 


lustrate the procedure. 
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8.8 MOTION GENERATION 


Once a manipulator has been described by both the forward and inverse solutions, 
the problem of defining its position in space in terms of the joint variables has 
been solved. In Section 8.5 we discussed how a desired position of the manipulator 
in terms of its hand matrix could be computed by using transformations. What 
was not discussed was how the motion from its current position to a desired endpoint 
was achieved. This section shows how the intermediate points between the initia] 
and final position of a manipulator may be computed. 


8.8.1 Position Trajectories and Velocity Profiles 


As discussed in Chapter 2, certain control over the motion of a manipulator js 
desired. For instance, we might like to specify the maximum velocity and maximum 
acceleration for a particular displacement, or the maximum time for a movement. 
One method for describing this is using a velocity profile which shows the velocity 
of a particular motion as a function of time. In one of its simpler forms, the 
velocity profile is trapezoidal in nature. A trapezoidal profile shows a distinct 
acceleration, constant velocity, and deceleration period. Various relationships can 
be developed for this waveform so that given three parameters (such as the total 
displacement, a maximum allowable acceleration, and a maximum allowable ve- 
locity, the remaining parameters describing the profile can be computed. Figure 
C.2.2 in Appendix C shows a set of waveforms describing position, velocity, and 
acceleration as a function of time, while Eqs. (C.2.1) through (C.2.3) define the 
position as a function of the maximum desired velocity and the three time intervals 
used to describe the motion. Based on these waveforms, given the desired dis- 
placement (area under the velocity curve), the desired maximum velocity, and the 
three time intervals for a motion, the position can be computed as a function of 
time. Other polynomials may also be used to describe the velocity and position 
waveforms; however, for our discussion we will use the trapezoidal velocity profile 
due to its simplicity. 

To control the velocity of a single joint, all that is necessary is to feed the 
position versus time data as the setpoint of a position servo loop, and (if the servo 
is designed properly) the joint should “track” the waveform. Note in this case 
that position information was explicitly sent to the joint but the velocity profile 
was implicitly sent (since velocity is the first derivative of position). 

This concept can be extended to joint interpolated motion (i.e., all joints 
start and stop at the same time) by simply forcing the total time for each motion 
to be the same while adjusting the maximum velocity for each joint based on 4 
fixed motion time and the desired displacement of each joint. The total time for 
the motion is obtained by looking at each motion individually. Since each joint 
could conceivably have a different displacement, then based on a desired maximum 
velocity and acceleration, each joint should require a different time to achieve its 
motion. By forcing all the joints to use the longest time, those axes whose motion 
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individually) to make the total area 
placement. 


pe reduced velocities (as opposed to moving 
under their velocity profile the required dis- 


8.8.2 Displacement Profiles Run thro 


Solution ugh an Inverse 


When using tool point control to position a manipulator, it is necessary to first 
generate a trajectory (position versus time based on a velocity profile description) 
in Cartesian geal and then use the inverse solution to obtain the joint variables 
as a function of time. The joint variable displacements as a function of time are 
the inputs to the S€rvos. Assuming that all the servos can track these profiles, the 
joints will move with the correct trajectories so that the tool point moves as de- 
scribed in Cartesian coordinates. It should be apparent that if a trapezoidal velocity 
profile is specified for a motion, the profiles of the individual joints may look 
nothing like it since the inverse transform is nonlinear. This is also true for the 
other waveforms, 1.e., position, acceleration, and jerk. To illustrate this, consider 
Figure 8.8.1. This shows a straight line drawn from the coordinate (x,,y,) to (x; 
ys) in terms of a Cartesian reference frame. 

Clearly, to accomplish this straight line motion with a Cartesian manipulator, 
all that is necessary is to produce a displacement profile for the x axis that goes 
from x, to x, and a displacement profile for the y axis that goes from y, to y;. As 
long as both profiles start and stop at the same time, the tip will trace out the line 
drawn in the figure. : 

Now let us assume that the Cartesian coordinate manipulator is replaced with 
a cylindrical one (6-R manipulator). The task is still the same—draw the diagonal 


(Xo, Yo) 


Ne 


Figure 8.8.1. Diagonal line in Carte- 


Shi ‘ hown with @-R manipulator. 
(0, 0) (x4, Ye) x —— sian frame s 
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10 10 


0 0 


X position coordinate vs. time T 


y position coordinate vs. time  T 


Vy max 





0 
— Vy max 
x velocity vs. time y velocity vs. time 
A, max Ay max 
0 0 
— Ay max — Ay max 
x acceleration vs. time y acceleration vs. time 


Figure 8.8.2. Position, velocity, and acceleration in Cartesian coordinates for 
motion from (0, 10) to (10, 0). : 


line from (x,, y.) to (%, y~)—but in this case we need to generate 6 versus time 
and R versus time. To accomplish this we will use the relationships: 


R(t) = Ve) + yA (8.8.1) 
0(r) = ATAN2 [y(2), x (1)] (8.8.2) 


Figure 8.8.2 shows x(t) and y(t) for a motion Starting at (0,10) and ending at 
(10,0) with the corresponding velocity and acceleration waveforms while Figure 
8.8.3shows R(f) and @(f) with their corresponding velocity and acceleration waveforms. 
In the case of a six-axis manipulator, there will be six sets of position, velocity. 
and acceleration waveforms (corresponding to each joint). 


10.0 


990° 
7.07 Qo 
R position coordinate vs. time 0 
6 position coordinate vs. time | 
0 
T 
0 


dr/dt dé/dt 





/—T/3—>| 
ae K—T/3—> 
dt2 K—T/3—>| 


Figure 8.8.3. Position, velocity, and acceleration in cylindrical coordinates for 
motion from (0, 10) to (10, 0). 


8.8.3 Cartesian Motions of a Manipulator 


To cause the manipulator to follow a trajectory in Cartesian space, one must first 
obtain a set of displacement curves for the desired motion (starting and stopping 
at the same time) similar to the discussion in Section 8.8.2. Then depending on 
the type of motion, the appropriate entries of the hand matrix are modified, or 
the hand matrix is operated on by a transformation for each discrete-time increment 
describing the trajectory. An inverse solution is performed, and the joint variables 
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fed to the servos. This operation is repeated until all the displacement curves are 


satisfied. 
The following describes the types of motion that can be achieved in Cartesian 
coordinates. 


1. Motions parallel to world axes 


To move the tool tip parallel to either of the three axes of the base reference 
frame, all that is necessary is to modify the appropriate position entry of the fourth 
column and perform the back solution. Note that the orientation of the gripper 
will remain the same throughout the motion. The update to the entry is the 
incremental change in position between the next and current updates, that is the 


difference between x[(n+1)T7] and x(nT). 


2. Motions parallel to tool axes 


To cause the manipulator to move along a path parallel to one of the tool 
axes, all that is necessary is to postmultiply the hand matrix by the appropriate 
translation matrix Trans(x,0,0), Trans(0,y,0), or Trans(0,0,z) and perform the back 
solution. Once again the orientation of the gripper will remain the same through- 
out the motion, and the value of x, y, or z in the translation matrix corresponds 
to the incremental change between updates. 


3. Rotation about tool axes 


In this case, postmultiplying the hand matrix by a rotation matrix will cause 
the tool point to remain essentially fixed in space and the gripper to be rotated 
about the specified axes. In this situation the orientation of the gripper changes. 
A displacement curve for the angle versus time needs to be generated and the 
incremental changes used as the argument for the Rot operator. 


4. Simultaneous motion of too} point and tool axes 


It may be desirable to cause simultan 
Orientation of the tool axes. This is the ca 
orientation of the tool axes different from 


hand matrix. To accomplish this the a ropri 
) opr 
the tool point, and a profile is ysareted t sat Oo es ate generated for moving 


hat oc ime 

as the Cartesian motion but generates an an curs for the same amount of 

rf — Sted ee ——e the Cartesian Position, a rotation matrix postmul- 

medated. Gece io ion the inverse solution is found and the servos are 
i , entry in the rotatj 

change in rotation since the last update ‘ation matrix should be the incremental 


cous motion of the tool point and the 
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These particular examples show control of th 
ince the end effector OF gripper is attached to 
ossible to control points other than the too] poi 
‘ation of any frame used to describe the manipul 
motions are also possible, for instance motion alo 


arbitrary Curve, and (3) a straight line with gripp 


€ tool tip. This is typically done 
the end of the arm. It is also 


ator). Of course more complex 
ng (1) an arbitrary vector, (2) an 
€r orientation changes. 


3.8.4 A Continuous Path Algorithm 


In certain applications it is desired to teach a series of points that the manipulator 
is to move through without stopping. This may correspond to an application in 
which a bead of glue or gasketing material is placed on the edge of a cabinet. 
There are many possible ways to accomplish this, including utilizing curve fitting 
algorithms in order to obtain a mathematical function of the curve. An alternative 
method presented in this section is simple yet effective and requires no complex 
curve fitting or time-consuming computations. Thus it is well suited for real-time 
control as implemented in robotic manipulators. 

To begin our discussion, assume that we have three points in Cartesian space 
as Shown in Figure 8.8.4. The starting point is (1,1), the intermediate point is 
(10,5) and the ending point is (5 ,10). Our objective is to trace a trajectory that 


nomes as close as possible to the intermediate point without stopping the manip- 
uiator. 


Point 3 


(ending) aw 
\ 
\ 
\ 
\ 
— Segment 2 
aa 
\ 
a 
‘x Point 2 
a (intermediate) 
se 
oa 
ie 
a S 
if egment 1 





3-4 5 6 7 8 9 10 11 


Figure 8.8.4. Model for continuous 
7 " path algorithm. 
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Consider now what would be done in Cartesian space if we wanted two distinct 
motions—that is a motion from point 1 to point 2 and another from point 2 to 
point 3. For the first segment, the total displacements for both x and y would be 
computed, in this case a distance of 9 and 4 respectively. Second, a velocity profile 
would be chosen that meets some criteria with the stipulation that both axes star 
and stop at the same time. Finally the displacement functions x(t) and y(t) woul 
be generated. If one were to plot y(¢) versus x(t) the result would be a straight 
line from point 1 to point 2. Now let us assume that the functions are discretize 
such that we obtain x(nT) and y(nT). In this case the time increment between 
each point plotted would be the same while the spacial distance would change as 
a function of the velocity of the point. During slow motions, the points would be 
closer together while at higher speeds the points would be spaced further apart. 
The same concept holds for the second segment except that the displacements in 
x and y become —5 and 5. Note that the time for motion of segment 1 is not 
necessarily the same time as segment 2. This may be due to a maximum velocity 
limit or an arbitrary choice. 

One method of preventing the motion from stopping as we go from segment 


x velocity y velocity 
ta1 1.0 sec 
Segment 1 tc1 5.0 sec 0 0 
dx1 9 
dyi 4 ta1}<— 
}~«—— tc1——»| 
—>|ta1}~<— 
ta2 1.0 sec —>|ta2|<— —>|ta2|<— 
tc2 5.0 sec 
Segment 2 dx —5 0 |} tc2 —>| 0 
dy2 5 
Combined 0 0 


+ tal +tc1+2 ta2+tc2 — -| 


, i ac- 
Figure 8.8.5. Continuous path profile with segment velocity profiles having the same 
celeration, constant velocity, and deceleration times. 
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Continuous Path Motion 


ta1 1.0 sec 


1 tc1 5.0 sec We 
Segment dx1 9 


dy1 4 


ta2 1.0 sec 
2 tc2 5.0 sec 
Segment dx2 —5 


dy2 5 





Figure 8.8.6. X-y trajectory for velocity profiles of Figure 8.8.5. 


1 to segment 2 is to add the two velocity profiles together. This is accomplished 
by starting the motion for segment 1. Therefore we obtain x,(nT) and y,(nT) and 
feed these positions as setpoints to the position servo of each axis in order to 
accomplish the motion. As soon as we reach the time when deceleration starts, 
we begin the motion of the second segment x2(”T) and y,(nT). During the time 
of deceleration for the first segment, the setpoints fed to the servos also include 
the motion for the second segment. Therefore as segment 1 is decelerating, seg- 
ment 2 is accelerating, and the net effect is a continuation of motion. The following 
figures show the velocity profiles for the independent axis motion of segment 1 
and segment 2 and the combined velocity profile for continuous motion from point 
1 to point 2 and then to point 3. Also shown are x-y plane trajectories. As one 
can see from examining Figures 8.85 and 8.8.7, the combined velocity profiles 
may be obtained by adding the slopes of the individual velocity profiles for each 
Segment. 

At this point it should be quite obvious how this concept can be extended to 
4 Series of N-line segments by simply starting the (n+1)th segment’s motion at the 
deceleration point of the nth segment. 7 
os The performance of this approach with respect to its ability to pass closely 
waaay intermediate point is dependent on the velocity of each segment and the 
res under the deceleration and acceleration curves of segment 1 and segment 2 
es oe In general the slower the motion, the nearer the trajectory comes 

€ intermediate point. Clearly, one can compensate for increases in speed by 
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tal 1.0 sec 
tcl 1.0 sec 
dx1 9 0 0 
dy1 4 tal |g — 
—| tcl | 
—| tal j~<— 
ta2 1.0 sec ta2 ~— 
tc2 4.0 sec 4 —>| ta2 k— ‘ 
dx2 —5 
dy2 5 


| 
L, 


Figure 8.8.7. Continuous path profile with segment velocities having different 
constant velocity times. 


Continuous Path Motion 


tal 1.0 sec 


tc1 1.0 sec We 
dx1 9 


dy1 4 


ta2 1.0 sec 
tc2 4.0 sec 
dx2 -5 
dy2 5 





Figure 8.8.8. 


X-y trajectory for velocity profiles of Fig. 8.8.7. 
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initially teaching a series of points and running the robot using this continuous path 
algorithm. If the position trajectory misses the points, they can be moved (inward 
or outward) until an acceptable performance is achieved. 


,g THE JACOBIAN 


We have previously described the forward and inverse solutions for a serial link 
manipulator whereby both the location and orientation of the tool point are defined 
in terms of joint variables or conversely, given the location and orientation of the 
tool point the corresponding joint variables may be computed. This particular 
approach when coupled with encoders and position servo loops can provide the 
means to control the tool point of a manipulator in space. Section 8.8 discussed 
how one could achieve motions with respect to both the tool point and base co- 
ordinates while Section 8.10 will discuss the architecture of such a control system. 

Another method for controlling the joints of a manipulator in a coordinated 
fashion is Jacobian control. This control method is based on relating the rates of 
the variables in one coordinate system to those in a secondary coordinate system. 
For example, a convenient coordinate system for a manipulator is that defined by 
its joint vector, Eq. (8.1.1), while a convenient coordinate system for a human 
observing the robot could be the coordinate frame associated with the hand or 
gripper as shown in Figure 8.5.1. 

The Jacobian relates the velocities of the joints to those of the tool point. 
Essentially, it allows the computation of a differential change in the tool coordinate 
frame due to a differential change in the position of the manipulator’s joints. As 
one would expect, by making use of the inverse Jacobian, the differential changes 
in the manipulator’s joints needed to accomplish a differential change in the tool’s 
coordinate frame can also be computed. 

If x; is a coordinate of the tool point (location given by the x, y, z coordinates 
referenced to the manipulator’s base and rotations about the x, y, or z axes as- 
sociated with the hand or tool), then the generalized function relating each coor- 
dinate of the tool point to the joint variables, 8,, can be written as: 


x; = fi(®1,-- - 9p) (8.9.1) 


where the maximum value of j corresponds to the number of Cartesian coordinates 
(typically 6), and n corresponds to the number of joints of the particular manip- 
Ulator, 


Taking the total differential of Eq. (8.9.1) yields: 


| 


i; > BYf(Or Su 0; (8.9.2) 


i=n 


. 2 J 9; (8.9.3) 


a) 
| 
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Assuming that both j and n equal 6, the coefficients Jji can be arranged ip 
matrix form so that Eq. (8.9.3) can be written as: 


F dx oh bh bh SA SA SA 6, 

: 560, 50, 00, 50, 06. 506 

x d of 8h dh dh 2 Ae 6, 

: ? 50, 80, 80; 80, 380; 80%, 

bs de oh of of of hh of 6, 

x, = 56, 58, 083 50,4 50. 506 (8.9 4) 

x, Sx ee 6, | 
56, 350, 60, 60, 50, 950, 

Xs Sy Ss dfs Ofs ofs dfs dfs 0. 
50, 506, 60, 86, 380; 9506, 

x, — Sfs 8fs Offs Ofe Sf. dhe 0. 


50, 80, 80; 380, 80; 80, 


The 6 X 6 coefficient matrix relating the hand velocities to the joint velocities 
is called the Jacobian. Note that depending on the degrees of freedom and the 
number of joints, the Jacobian matrix may not be square. That is, it may be an 
n X m matrix where n is the number of joints of the manipulator and m is the 
dimensionality of the Cartesian coordinates of the hand under consideration. 

A careful inspection will show that the Jacobian is a time-varying quantity 
Since it must be evaluated for instantaneous joint velocities and the actual position 
of the joints. It is clearly dependent on the kinematic structure of the arm and 
the coordinate system used to express the hand or tool coordinate frame. 

If the matrix is invertible, then it is possible to calculate joint velocities given 
the velocities associated with the displacement and Orientation of the tool point. 
Recall that only square matrices that are nonsingular may be inverted, and therefore 
it is quite important to determine whether the Jaco 
In the case of nonsquare Jacobians, 
relationships. 

Singularities are points in the works 
become extremely large in order to maint 


bian or its inverse can be singular. 
pseudo inverses may be used to obtain inverse 


pace where the velocity of a joint must 
ain the proper relationship between itself 
desired trajectory. Some possible solutions 


a constrained velocity; or (3) adding an additional, redundant degree of freedom. 
By examining the Jacobian or its inverse, si 


positions or areas in the workspace w 
illegal. We should also examine 
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determinants approach zero. For these cases while the condition that forces the 
determinant to be zero may not be physically attainable by the manipulator, ve- 
locities of some Joints may reach large values which may be beyond the capabilities 
of the control system. Of course, heuristics may be substituted for the Jacobian 
and inverse Jacobian relationships near these areas. Example 8.9.1 shows a con- 
dition where the determinant of a J acobian approaches zero. 

Logically, one may surmise that if the hand position is expressed in Cartesian 
coordinates then the Jacobian will be nonsingular since by design, a small motion 
of each joint will not cause large changes in the hand position coordinate. Keep 
in mind that these incremental motions of the joints do not correspond to Cartesian 
trajectories of the tool tip. For the case of the inverse J acobian, it should be evident 
that singularities may exist due to the nonlinear nature of the relationships. 


a ——— eee 


EXAMPLE 8.9.1: THE JACOBIAN OF AN R-0-Z MANIPULATOR 


For an R-0-Z manipulator similar to Figure 8.7.4 but with vertical motion in 
place of rotary motion at the last joint), the equations relating the robot’s 
joint space to Cartesian space may be written as: 


x = rcos 8 
y =rsiné@ (8.9.5) 
Z 


vA 


The set of relationships given by Eq. (8.9.5) corresponds to Eq. (8.9.1). 
Taking the total derivative yields a relationship similar to Eq. (8.9.2). 


dx = drcos 8 — rsin 8 dé 
dy = drsin ® + rcos 6 d@ (8.9.6) 
dz = dz 


Writing Eq. (8.9.6) in matrix form yields: 


dx cos@ —rsin®@ O]||dr 
dy | = | sin 0 rcos® O| | dé (8.9.7) 
dz 0 0) af dz 


The inverse relationship is given by: 


dr cos6 sin® O}| | dx 
—sin§@ cos @ 
sole |e See Ody (8.9.8) 


r r 


dz 0 0) 1 dz 
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It is possible to rewrite the inverse Jacobian in Eq. (8.9.8) solely as functions 
of x, y, and z to facilitate computations and if we are working in Cartesian 
coordinates it makes more sense to use these variables. The result becomes: 


dr xir ylr O} | dx 
do | =| —yl/r?2 x/r? 0] | dy (8.9.9) 
dz 0 0 1) Ldz 


Investigating the determinant shows that J becomes singular if r equals 
zero. While mathematically possible, in a physical robot it would be quite 
difficult for r to become zero and, for all intents, taking the physical situation 
into account this Jacobian is nonsingular. However, near positions where r 
approaches zero, large velocities are required on the 0 axis. For example, 
assume that we wish to trace a trajectory in an x-y plane along the line x = 
a with a constant velocity in the y direction, V, and of course a velocity in 
the x direction that is zero. Using the inverse Jacobian [Eq. (8.9.9)] we 
obtain the following relationships: 


r= yi/r V, 
6 = x/rP V, (8.9.10) 
z=0 


Since x is a constant, one sees that 6 will be a maximum when r is at its 
minimum value or when y = 0. Thus the maximum value of 6 is found to 
be V,/x which in our example is V,/a. Now as the line moves closer to the 
y axis the magnitude of x = a grows smaller and the velocity needed on the 
@ axis increases to a large value. 

As a matter of completeness, the determinant of J~' is given by: 


det J-! = 1/r (8.9.11) 


which substantiates the previous results—that motion passing through the 
point corresponding to r = 0 requires an infinite velocity on the 6 axis. 


8.9.1 The Jacobian in Terms of D-H Matrices 

To relate the position of the tool point of a manipulator (as defined in Cartesian 
coordinates) to the joint angles of the manipulator, one may make use of a 
forward solution and obtain a “hand” or “T” matrix. Recall, that while the 
matrix provides a wealth of information, the orientation information, describin® 
the three vectors comprising the coordinate frame attached to the tool plate, } 
given in terms of the basis set attached to link zero of the manipulator (or as 
fixed coordinate frame). As shown in Eq, (8.9.4), the Jacobian is defined w! 
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ee ihe "by 7A. th — IN position (dx, dy, dz) and rotations about the tool 
Fa re we need a ‘ae 
in these variables to the hand matrix. method of relating incremental changes 
eference |1 

nine to the , Stay : method that relates differential changes in joint 
: ine di changes in the tool point’s position and orientation. 
The following ciscussion uses the concepts of the approach in [1] 

| igen ang 2 discussion, consider a hand matrix T and the result of a differ- 

entia ge in its entries, dT. The resultant hand matrix (T + dT) may be 
computed using matrix operators as shown below. 


T + aT = T Trans(dx,dy,dz) Rot(x,8x) Rot(y,3y) Rot(z,8z) (8.9.12) 


Equation (8.9.12) shows translation and rotation operators postmultiplying a T 
matrix and therefore performing their operations about its established coordinate 
frame. In the case of differential rotations, if second order terms (such as dxdy) 
are neglected and all angles are considered small, then the following approximations 
may be used: 


sin 6x ~ 8x (8.9.13) 
cos 6x =~ 1 (8.9.14) 


When Eas. (8.9.13) and (8.9.14) are used and second order terms are set to 
zero, rotation operators become commutative (and therefore the order of matrix 
multiplication becomes immaterial). 


For small rotational changes, the product of the three rotation operators 


causing rotation about the x, y, and z axes (or normal, orientation, and approach 


vector directions) becomes: 


1 —-—82 dy 0 
SZ 1  —&x 0 

_ By Sx 1 0 (8.9.15) 
0 0 0 1 


the differential angular change around the 
ectors associated with the hand coordinate 


d in radians. 
the differential Trans operator, we obtain: 


where 8x, Sy, and 8z correspond to 
normal, orientation, and approach V 
System. Of course, these are expresse 
If Eq. (8.9.15) is premultiplied by 
1 —6Z Sy ax 
—sx d 
e UF es (8.9.16) 
0 0 0 1 
The dx, dy, and dz entries correspond to incremental positional changes in the 
tool point with respect to the previous location of the tool point. 
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Utilizing Eq. (8.9.16) to solve Eq. (8.9.12) for dT results in: 


dT = T (Trans Rot Rot Rot — I)=TA (8.9.17) 


where A is given by: 


0 -8&z dy dx 
| 8& O —%& dy 
A = _ By 5 y 0 A (8.9. 17a) 
0 0 0 O 


e have the ability to compute the 
knowledge of differential changes 
All that is needed is a way of 
rential changes in the tool 


__ At this point, one should recognize that w 
differential change in the T matrix, dT, if we have 
in the position and orientation of the tool point. 
relating differential changes in joint positions to diffe 
position so that Eq. (8.9.17) may be computed. 

Recall that by definition (see Section 8.6.3), the hand matrix is the product 
of A matrices that relate successive frames of a serial link manipulator together 
[Eq. (8.6.3)]. Furthermore, each A matrix has a single joint variable associated 
with it, and follows the rule that if it is rotary, the rotation is about the preceding 
frame’s z axis, while if the joint is prismatic, the translation is along the preceding 
frame’s z axis. Using this information, we may write the following equation for 
changes in the T matrix as a result of an incremental change of a single joint 
variable. To aid in visualizing what is happening, our derivation will concentrate 
on a kinematic chain with six joints, with the incremental changes occurring in 


joint 3. Therefore, we may write: 
dT = T A; dgq3 = Ao: Air *A3 Azq Aas Ase 493 (8.9.18) 


Equation (8.9.18) says that dT, the change in the hand matrix, can be represented 
by postmultiplying the hand matrix by some unknown A, as given by Eq. (8.9.17a), 
or inserting a differential rotation (or translation) matrix, 7A, in the appropriate 
location of Eq. (8.6.3). Remember, that while the matrix 2A, is of the form of 
Eq. (8.9.16) the only valid entries are 8z or dz. 
Thus the change in the hand matrix resulting from a differential change in 
joint 3 is 
dT/ldq, = T A, (8.9.19) 


where 
A; = T7' [Agr Aiz 7A3 Ag Ags Ase] (8.9.20) 


Since the T matrix is the product of the A matrices, Eq. (8.9.20) may be written 
as: 
A; = Ags Asa Ag; Az) A>, Aj Ao, Aj “Kh Ax4 A4s As¢6 (8.9.21) 
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which simplifies to 


A; = A¢s As4 Ag; “A; Ax, Ags As (8.9.22) 
Using the notation of Table 8.7.5, Eq. (8.9.22) may be written as: 
A, = °T3 2A, 37° (8.9.23) 


The result we have attained allows us to compute the differential change matrix 
which would postmultiply the T matrix to produce dT. Another way of looking 
at this result is that we have found the contribution to each possible nonzero entry 
of A; due to a differential change in joint 3. Since the changes which result from 
2A, are restricted to rotations or extensions about the z axis, we can relate these 
changes which correspond to a single joint variable to differential changes in po- 
sition and rotation which occur in As. 

In this way we have also found the third column of Eq. (8.9.4). The next 
step is to obtain the actual entries for this column. Our solution will take both 
translations and rotations into account. However, as noted previously, since only 
a translation or rotation may occur, terms corresponding to the nonmoving direction 
will be set to zero. 

Starting with Eq. (8.9.23), we replace A; with the general incremental change 
matrix of Eq. (8.9.17a) and 7A; with Eq. (8.9.17a) having set the terms {Sx, dy, 
dx, dy} equal to zero. Finally, we use the symbolic representation of a general 
transformation matrix as given in Table 8.3.3 for >T° and the formula for the inverse 
of a transformation matrix in terms of the symbolic entries as given by Eq. (8.4.2) 
for °T?. 

After performing the appropriate matrix multiplications and reducing terms 


such as: 

— Oy a, + 0, a, — Nn, (8.9.24) 
by noting cross product relationships, we are left with the following entries in A, 
due to either a rotational or translational change in joint 3. 


() —a,9; 0,0; d; n, za (n, Py + ny, Py); 
a8, 0 —M,d; 4,0, + (Ox Py + Oy Py); (8.9.25) 
-08, nb OO Gat (ay Py + My Px)®; 
0 0 0 


The term d,; corresponds to the incremental change in length while 3, is the rotary 
Change. Since only one change is possible, either 5, or d; must be set to zero. 
The entries of Eq. (8.9.25) correspond to those of Eq. (8.9.17), i-e., {8x, dy, 82, 
dx, dy, dz} for a change due to joint 3. 

It should be apparent that equations similar to Eq. (8.9.18) can be written 
for each joint of the manipulator. Additionally, a relationship such as Eq. (8.9.25) 
can be generated in terms of the entries of equations similar to Eq. (8.9.23). 
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Specifically the columns of the Jacobian of Eq. (8.9.4) are determined as 
follows: 


Col 1 = fCT) = f(Z) 


Col 2 = f(T) 
Col 3 = f(T) (8.9.26) 
Col 4 = f(T) 
Col 5 = f(*T) 
Col 6 = f(T) 


The method of using the Jacobian then consists of forming Eq. (8.9.4) as 
discussed previously, evaluating the actual Jacobian for the current known joint 
positions, {8, . . . 6,} premultiplying the vector of differential joint changes, and 
obtaining the vector {dx, dy, dz, 8x, 85y, 8z}. The results of the multiplication can 
then be placed in Eq. (8.9.17) and used to find dT. 


8.9.2 Jacobians in Force Control 


The transpose of the Jacobian relates the hand frame forces or torques to those at 
each of the joints. 


OS er es 9) (8.9.27) 


where the column vector, [ has entries corresponding to torques of forces depending 
on the type of joint and the column vector, F has entries of force or torque relating 
to the degrees of freedom chosen. Fora six-degree-of-freedom situation, it consists 
of three forces corresponding to the x, y, and z directions and three torques (or 
moments) corresponding to rotations about the x, y, and z frames of the hand. 
Equation (8.9.27) may be derived using the method of virtual force [1]. 

If the transpose of the Jacobian is invertible, then it is possible to solve for 
the forces and torques applied by the hand with respect to the forces or torques 
applied by the joints. 


Fl = OP) (8.9.28) 


By measuring the torque or force applied by each actuator and using some type 
of filtering technique to reduce noise (as is inherent in the measurement of the 
current flowing in a dc motor due to such factors as brushes or coupled noise), 
Eq. (8.9.28) can be used to determine the forces applied by the hand. 


eee ree eee 


EXAMPLE 8.9.2: STATIC FORCE OF AN R-0-Z MANIPULATOR 


Example 8.9.1 presented the Jacobian and its inverse for a mani imi 
, ; anipulator similar 
to Figure 8.8.4. Using Eq. (8.9.27) we obtain the following relational 
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Figure 8.9.1. R-@ manipulator applying 
x —_—_» forces F, and F,. 


i, cos 6 sin 8 O} | F. 
T,| =| —rsin@ rcos®@ 0]| F, (8.9.29) 
F, 0 0 1) LF. 


Figure 8.9.1 shows a schematic in a fixed z plane. If one drew two force 
vectors as shown, then the torque on the 6 axis and force on the r axis to 
generate these forces are given by Eq. (8.9.29). 

For example, if one wished to generate a force of F, as shown with F, 
equal to zero, the torque to be supplied by the 6 axis and force to be supplied 
by the r axis are given as: 


F, 
Ty 


As a numerical example, assume that 6 = 45°, and r = 10.0 in. The force 
that must be exerted in the outward direction of the r axis (by its actuator) 
is 0.707 F, while the torque that must be generated by the @ axis’s actuator 


is —7.07 F, (which is in the clockwise direction). 
ee eUUU I aE nNnEI NE EERERRREERRIRRRRREREEEEEenennene 


cos 6 F, 


—rsin 6 F, 


8.10 CONTROLLER ARCHITECTURE 


In implementing motion control for a robotic manipulator various approaches may 
be chosen. We will discuss three concepts which result in defining setpoints to 


the joint servos. 


e Joint position control (JPC) 
e Resolved motion position control (RMPC) 
e Resolved motion rate control (RMRC) 
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8.10.1 Joint Position Control 


The architecture of a joint position control scheme is shown in Figure 8.10.1. This 
particular architecture is suitable for: 


e Individual joint control 

e Multiple joint motions stopping at various times 
e Joint interpolated motion (point-to-point) 

e Continuous path control of the joints 


Note that each joint of the manipulator is controlled by a position servo loop. 
The joint trajectory control algorithm accepts a new joint setpoint, J,, and tra- 
jectory parameters (such as velocity and acceleration), and based on system pa- 
rameters and constraints computes a position profile for each joint of the manip- 
ulator. 

The total displacement that each joint moves is its new setpoint minus its 
current position. It should be obvious that to move a single joint, the new setpoint 


Joint 1 Position Controi Loop 
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Figure 8.10.1. Joint position control. 
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Jy should contain the current position of all the joints except for the desired final 
position of the joint which is to move. 

To implement the continuous path algorithm of Section 8.8.4, a command 
must be given to the trajectory control algorithm indicating that continuous path 
motion is desired along with a series of joint vectors. This is typically accomplished 
by having the master processor send the joint vectors along with a command string 
to the trajectory control algorithm. The command string specifies the trajectory 
parameters, the new joint vector, and whether the motion is point-to-point or 
continuous path. 

It is interesting that this architecture is essentially open loop if one considers 
the actual joints’ position and the joint trajectory control algorithm. Typically, 
when the joint trajectory algorithm has sent its last setpoint for a motion, it checks 
to see that the position error of each servo loop is within some specified tolerance. 
Once all of the joints are within their defined tolerance (a position error) the 
trajectory control algorithm signals the master that the trajectory is completed. 


8.10.2 Resolved Motion Position Control 


The architecture for resolved motion position control is shown in Figure 8.10.2. 
This topology is necessary to implement Cartesian control of the manipulator as 
discussed in Section 8.8.3. A comparison of Figure 8.10.2 with Figure 8.10.1 shows 
that the control of the joints is essentially the same. ‘That is, a joint Vector is sent 
to the position servos at every update. The primary difference between the two 
figures is the inclusion of the inverse solution. In Figure 8.10.2, the trajectory 
control algorithm works in Cartesian coordinates and then sends its position data 
to the back solution algorithm before updating the joint servos. 

The input to the Cartesian trajectory control algorithm is a hand matrix 
defining the final position and orientation of the tool point after the motion. 
Depending on the type of motion (see Section 8.8.3) the appropriate intermediate 
hand matrices are generated and then passed to the inverse solution to get the 
joint vector at each update. 


8.10.3 Resolved Motion Rate Control 


The architecture of a controller using resolved motion rate control is shown in 
Figure 8.10.3. We have omitted the trajectory control algorithm in order to con- 
centrate on the actual control signals sent to the joints and controller. However, 
note that the input, T(nT), 1s essentially the output of a scheme similar to that of 
Figure 8.10.2. 

The major difference between this control Strategy versus joint position con- 
trol and resolved motion position control 1s that the servos controlling the joints 
are velocity as opposed to position servos. The input to the system is a hand 
matrix, T(nT), which may come from a trajectory control algorithm and is updated 
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Figure 8.10.2. Resolved motion position control (RMPC), 


every I'seconds. This is immediately converted to a column vector with six entries 
corresponding to the position of the tool point and the angles of the three tool 
axes. The input to the inverse Jacobian is the difference between this setpoint 
vector and the current position of the tool as computed in the feedback loop. 
Recall that the inverse Jacobian relates Cartesian rates to jOint rates, and therefore 
the output of the inverse Jacobian is a velocity command, essentially the derivative 
of the joint vector. The diagonal gain matrix K applies the appropriate gain to 
each velocity which is then fed into the velocity servos that control each joint. 
Encoders on each joint axis determine the position, which is then converted to a 
hand matrix and the column vector with the position of the too] point and its angles. 

As opposed to the previous two schemes, this topology is essentially a closed 
loop control. It is important to note that the actual position of the manipulator 
is compared with its setpoint to generate the velocity control signal. One advantage 
in using this scheme is that the velocity commands wil] remain fixed b 
and therefore cause the joints to continue to move between updates. In the case 
of a position loop, once the setpoint has been reached, the joint will stop. Thus 
velocity loops generally produce a smoother motion for Slow update rates. | With 


etween updates 
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Figure 8.10.3. Resolved motion rate control (RMRC). 


today’s extremely fast computational elements this advantage may not be as great, 
since the position setpoints can be generated at a rate that is faster than the arm 
dynamics. This can produce error signals which will not go to zero between updates 
to the position servos, and therefore the servos continue to drive the arm between 
updates due to a following error. 


8.11 SUMMARY 


In this chapter we have presented the concept of using homogeneous coordinates 
to represent the position of a manipulator in space. By using various matrix 
Operators it was shown that the position of the manipulator’s tool tip could be 
referenced to various frames and moved with respect to a base frame. 

Rules were presented for establishing coordinate frames on the links of a 
kinematic chain, and a method of defining the relationship between successive links 
by matrices was described. 

The forward solution (relating joint angles to Cartesian coordinates) and the 
INVerse solution (relating Cartesian coordinates to joint angles) were detined., 

The Jacobian that relates the rates between the variables of different coor- 
dinate systems was introduced. Additionally a method of computing the J acobian 
In terms of the A matrices of the manipulator was presented. The use of the 
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manipulator’s Jacobian to relate joint torques or forces to forces at the tool tip 
was shown. . . 

Algorithms to define the trajectory of the manipulator in Cartesian and joint 
space were discussed along with a simple continuous path algorithm. The rep- 
resentation of the controller architectures needed to achieve these algorithms was 
also shown. 


8.12 PROBLEMS 


8.1 Show how to add two vectors represented in homogeneous coordinates with different 
scale factors. What is the scale factor of the result? 

8.2 Verify that to multiply the vector of Eq. (8.2.4) by 2, all that is necessary is to divide 
s by 2. 

8.3 Redo Example 8.2.4 using a vector with a nonunity scale factor s. Is s preserved? 
What happens if the scale factor of Trans (a, b, c) is not 1? 

8.4 Derive rotation in the y-z plane and the z-x plane using the geometric approach 
presented in Section 8.3. 

8.5 Derive the rotation formula using vector techniques. 

8.6 Verify Eqs. (8.2.25) through (8.2.27). 

8.7 Using graphical techniques, prove that it is always possible to make two reference 
frames coincident by performing at most two rotations and one translation. Discuss 
the implications of the order of the operations. 

8.8 Investigate the effects of multiplying matrices with nonzero perspective and nonunity 
scaling terms on points. 


8.9 Verify that A,, and A,, are mathematical inverses. Use the argument of transforming 
from frame 1 to frame 2 and then from frame 2 to frame 1. 


8.10 Verify Eqs. (8.3.11) through (8.3.16). 

8.11 Prove Eq. (8.4.2). 

8.12 Prove Eq. (8.4.3). 

8.13 Perform the same operation as discussed in Section 8.4.2 to erect a wedge on a table, 
but use a different set of transformations. 

8.14 Premultiply and postmultiply Eq. (8.3.7) by Rot (z, 90). Plot the relative axes in 
space. Examine how the transformation affects points. 

8.15 Referring to the task described in Section 8.5.2: 
a. Find the transformation matrix that will draw the A at a point in sector 2 where 

line segment ac is at a radial distance of } the original (i.e., closer to the origin). 

b. Find the transformation that will draw the A upside down. 

8.16 Describe the effects of premultiplying Eq. (8.5.2) by the operators Trans (0, 0, 42) 
and Rot (z, 180). How does the result differ from Example 8.5.1? 


8.17 For the task defined in Table 8.5.1, determine the transformation needed to transform 


point a to some point above it. Discuss the sign of the variables in the matrix. What 
happens if the original sign is negated? 


8.18 Devise and mathematically test a task that uses postmultiplications to pick up objects 
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of various heights. Consider the PUMA pro i le given in Chapter 7 
as a model for this task. programming example Biv 


g.19 Establish numeric values for the positions of the pallets and pickup points of Example 
8.5.4. Plot on graph paper, and verify the procedure. 

g.20 Referring to Section 8.5.5, demonstrate that Agase,vision-frame iS a Constant. Make a 
sketch on graph paper and do a numeric example. 


g.21 For the Stanford arm shown in Figure 8.6.7, change the direction of %1, redraw the 


schematic diagram, and determine the link parameters and A matrices. What does 
this change do to the T matrix? 


8.22 For the six-jointed Puma, select another valid set of coordinate systems, and determine 
the link parameters and symbolic A and T matrices. 


3.23 Consider the forward solution of the Stanford arm. Assume that angles may be 
resolved only to 1° and linear motion to increments of 0.01 in. Compute the error 
for each element of the hand matrix for an arbitrary joint vector. 

8.24 Illustrate the problem of multiple solutions using the Stanford arm of Figure 8.6.7. 
Specifically illustrate the same position as shown in the figure with joints 4 and 6 rotated 
180° in opposite directions. What other combinations achieve this result. Consider 
the sum of the angles of joints 4 and 6. 

8.25 Given a two-joint-and-link kinematic chain with coordinate frames attached at the 
extreme ends (ground and link 2), using vector techniques (dot- and cross-product 
relationships), determine the value of the two joint variables. Assume both joints are 
rotary and the link lengths are d, and d,. See Figure 8.6.3. 

8.26 Write a computer program that can perform joint interpolated motion for the manip- 
ulator of Example 8.7.1. The inputs are to be the desired final position given in terms 
of a legal hand matrix along with a maximum motion time. Assume a maximum 
acceleration and velocity for each joint. Output should be in the form of velocity 
profiles for each joint. : 

8.27 Extend the program of Problem 8.26 to include the capability of continuous path 
motion. In this case the inputs should be a set of legal hand matrices (defining the 
desired positions) along with a maximum time for passing through each segment of 
the motion. Once again outputs should be in the form of velocity profiles. 

8.28 Obtain the Jacobian for the manipulator of Example 8.7.1 in terms of the method 
shown in Section 8.9.1. 

8.29 Block out a control strategy using joint position control, (JPC), and resolved motion 
position control, (RMPC), for the manipulator of Example 8.7.1. 

8.30 Define all the relationships needed along with the control structure to implement 
resolved motion rate control, (RMRC), for the manipulator of Example 8.7.1. 
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Design Example 


9.0 OBJECTIVES 


The objective of this chapter is to bring many of the concepts presented in previous 
chapters to bear in solving a practical problem. The reader will be challenged to 
utilize this information in solutions that will permit the authors’ integrated approach 


to be more fully appreciated. 


9.1 MOTIVATION 


The motivation for this chapter is to provide a complete example whereby the 
reader has the opportunity to consider many aspects of the application of the 
technology of robotics and associated fields. The example that has been selected 
provides a simple yet rich framework that permits the utilization of many of the 
principles presented in previous chapters. The reader is encouraged to design, in 
as Complete a way as possible, practical solutions to the problems presented. The 
text suggests possible solutions to the application problems, but the reader is chal- 
lenged to improve on these, either by creating simpler ones or by creating more 


general and more sophisticated solutions. 


*2 INTRODUCTION 


tter throughout this book, a specific 


To illustrate the various topics and subject matt 
riety of considerations to be made. 


example has been selected that will allow a va 
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Figure 9.2.1. General room layout of an egg packing system. (Not drawn to scale.) 


This example, involving an egg packing system, is described below and illustrated 
in Figure 9.2.1. A detailed solution to the problem of eliminating ‘“‘bad eggs’”’ is 
presented in this chapter. | 


Egg Packing Problem 


The flow of activities required of such a system is: 


1. Pick up an egg from the conveyor belt. 


2. Hold the egg up to a bright light and determine if the egg is clear (i.e., has 
no embryo growth). This process is known as “‘candling.” 


3. Place the egg into a reject bin or a receptacle in an egg carton, depending 
on whether or not it contains an embryo. 


Although the problem statement itself is straightforward enough, there are 
clearly many subproblems associated with the actual implementation of its solution. 
Figure 9.2.2 shows one example of a general schematic layout for an egg packer/ 
checker. Before implementation of this system can be achieved, however, a num- 
ber of additional assumptions and/or specifications are required. These include 
assumptions as to the conveyor speed, egg weight, carton size, robot geometry, 
type of sensors, gripper geometry, and so on. In this respect it is suggested that 
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the reader consider Problems 9. 1 through 9.4 given at the end of the chapter before 
proceeding to the next section. 


In the following sections, a possible solution will be presented. In particular, 
the remainder of the chapter will consider the following: 


e Robot design and process Specifications 

e Motor control sequences 

e Motor and drive mechanism selection for all axes 
e Encoder selection 

e Computer architecture and control structure 


e Vision system considerations, including camera resolution, camera selection, 


use of photo-optical interrupters, colorizer/density measurements, and cali- 
bration 


Figure 9:2.2 illustrates in more detail the general layout for the egg packer/ 
checker. Some assumptions that the text solution presumes are the following: 


e A photointerrupter will be used to stop the conveyor when an egg interrupts 
the light beam. 
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Figure 9.2.2. General layout for egg packer/checker. 
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© A CCTV will be used to locate the egg in the field of view. 

e Candling of the egg will be accomplished by transilluminating the egg with a 
bright light and then using a vision sensor to read the egg’s density pattern 
and/or color. 

e Egg placement will either be in the eg 
on the back portion of the conveyor (if the egg 
designated as the reject area. 


¢ carton (if the egg passes candling) or 
fails candling), which is 


9.3 ROBOT DESIGN AND PROCESS SPECIFICATIONS 


Although there are many solutions to the problem described above, in what follows 
we will suggest one of them so that an appreciation may be gained of the many factors 
that influence the final design. Obviously, others are possible and the reader is 
encouraged to investigate one or more of these (see Problems 9.1 through 9.7). 

In what follows we have assumed that the robot has four axes: r, 0, z, and 
o. Moreover, the control and mechanical specifications of the process to accom- 
plish the candling task (and how they influence the robot itself) are presented 
below. The actual motion sequence is then stated and a discussion of the me- 
chanical description of the robot given. Finally, the actual design of the robot 
actuators is included to conclude this section. 


9.3.1 System Specifications 


1. Cycle time = 3.0 s maximum. 
2. Three distinct moves per cycle: 
a. Move to conveyor and acquire an egg 
b. Move to the candling station 
c. Place the egg in the carton or into the reject area 
3. Three pauses during a cycle: 
a. 0.20 s required to close gripper (grasp the egg) or open gripper 
b. 0.05 s to perform the candling operation 
c. 0.20 s required to place egg in carton by opening gripper 
. Weight of egg = 3 02. 
. Weight of gripper = 13 oz. 
. Positional resolution: at least 0.05 in. 


. All axes should move simultaneously and finish moving at the same time (1.€., 
coordinated motion is required). 


NA wm sd 


9.3.2 Mechanical Description of the Robot 


Although there are many manipulator designs that will meet the specifications, for 
purposes of illustration we will work with a specific one. The reader is encourage 
to modify the assumptions and repeat the calculations. 
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At first glance, a robot that appears to meet the specifications given in Section 
9.3.1 should have one revolute and two prismatic joints. In fact, one additional 
rotary axis is needed to permit orientation of the egg, which is lost when the arm 
moves. Thus although a 6-r-z manipulator can pick up the egg, a joint whose 
axis of rotation is parallel to the primary @ axis is also needed. With reference to 
the general layout in Figure 9.2.2, specifications for these axes will be assumed to 
alee 
r: 18-to-24 in. reach 
. 8: +90° waist rotation 
. : 360° wrist roll 
z: 2 in. vertical travel 


What is not clear is how to configure these axes. 

From the standpoint of load, the major axis of the robot will be @ since it 
carries the entire robot’s mechanism (including the other joints) in addition to 
the gripper and payload (egg). As a consequence and not surprisingly, it will 
be seen shortly that this joint will require the largest servomotor to drive it. 
This actuator will be coupled to a harmonic drive and the entire assembly mounted 
in the fixed base so that it will be unnecessary to move its weight. The r- or 
reach-axis motion will be obtained using a servomotor mounted in the shoulder 
assembly. It will be coupled to an Acme thread lead screw 7 in. inlength. The 
z axis will be located at the end of the r linkage so that its tip velocity is 
perpendicular to the r axis motion. Its travel will be obtained using a bang- 
bang actuator (e.g., a pneumatic cylinder) since only two distinct vertical po- 
sitions are needed, one for travel and one for both pickup and deposition of an 
egg. The wrist roll joint () is located at the opposite end of the z cylinder 
and will require a small servomotor coupled to a simple gear train. Each of the 
three motors will have an optical incremental encoder mounted on its end bell 
so as to permit the shaft positions to be monitored. 

It will be assumed that the overall weight of the portion of the robot that the 
§ axis must move is about 6 lb (including the load). The weight breakdown is 
shown in Table 9.3.1. A sketch of this manipulator and the special gripper is shown 
in Figure 9.3.1. 
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TABLE 9.3.1 MANIPULATOR AXIS LOAD 
BREAKDOWN 


ag a 
. Payload (egg) = 3 02 

Gripper (including open/close mechanism) = 13 oz 
o gearbox = 18 oz 

o axis motor = 7 0Z 

z axis actuator = 7 0Z 

r axis structure (24 in. long) = 25 oz 

_ p axis lead screw = 16 0z 

r axis motor = 7 0Z 
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Screw Holes 
For Mounting 


oO _ 


Air Cylinders 
(shown retracted) 





Foam 
Rubber 


(b) 
Figure 9.3.1 (continued). 


9.3.3 Motion Sequence 


The assumed sequence of worst-case moves that permits a single egg to be candled 
and packed is now described as a series of “primitives” that might be used by a 
robot controller (see Table 9.3.2). Figure 9.2.2 may be used to visualize these 


actions. In what follows, we assume that the robot’s gripper is initially located 


over the egg carton. 
The motion sequence described above can be summarized in a time-and- 


motion state diagram (see Figure 9.3.2) that indicates when each of the axes is to 
move and also when the candling operation and gripper motion is to take place. 
The figure resulting from this describes the states of the individual quantities or 
variables. It is observed that there are two or three states associated with each 
of the actuation axes. The uncertain states (4, 5, 6, 13, 14, 15) are indicated by 
dashed lines. It is important to note that even though one axis could finish its 
motion in a shorter period of time than Is indicated (e.g., r or b), the requirement 
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TABLE 9.3.2 MOTION SEQUENCE SUMMARY 


Enea eee 


Action Time 


eee 


1. Move 6 axis’clockwise to egg pickup location (worst-case 
distance = 150°) 


2. Extend r axis to egg pickup location (worst-case distance 


= 3 in.) 

3. Move ¢ axis to orient gripper so that egg is picked up on Worst-case time for steps 1, 2, 
long axis (worst-case distance = 360°) and 3 is 750 ms 

4. Move z axis down to egg pickup height 200 ms 

5. Close gripper and acquire egg 200 ms 

6. Move z axis up to travel height 200 ms 

7. Rotate 6 axis counterclockwise to candler location (worst- 
case distance is 75°) 

8. Retract r axis to candler location (worst-case distance is Worst-case time for steps 7 
3 in.) and 8 is 500 ms 

9. Candle egg 50 ms for vision “‘snapshot”’ 


10. Rotate @ axis counterclockwise to egg drop-off or 
clockwise to reject point (worst-case distance for either 
move is 75°) 


11. Extend r axis to egg drop-off (or reject) point (worst-case 
distance = 3 in.) 


12. Rotate o axis back to egg drop-off (or reject) point Total time for steps 10 
(worst-case distance is 360°) through 12 is 500 ms 
13. Move z axis down to egg drop-off height 200 ms 
14. Open gripper to deposit candled egg 200 ms 
15. Move z axis up to travel height to get ready for next 200 ms 
cycle 





of coordinated motion means that the axis that takes the longest time ‘“‘paces’’ the 
other axes. 

Additionally, it may be interesting to note that the actual motion times may 
be less than indicated, when worst-case motions are not required. In general, the 
cycle time for completion of packing an egg carton will be less than the simple 
summation of the worst-case times. The frequency of occurrence of eggs with 
embyros will also affect the cycle time for egg packing. 


9.3.4 Motor and Drive Mechanism Selection 


The design of the z, 8, r, and ¢ axes will be considered separately and in that 
order. It will be assumed in what follows that the z axis motion is obtained by 
using an air (pneumatic) cylinder or solenoid to move the gripper up or down by 
a small amount. Actually, the purpose of this axis is permit the grasped egg to 
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Figure 9.3.2. Time and motion state diagram (shown for a ‘“‘good egg”). Note: 
The numbers in circles correspond to the actions defined in Table 9.3.2. 


clear the tabletop. This procedure has the advantage of eliminating a servomotor 
at the tool end of the manipulator, thereby reducing weight and cost. 
@ is chosen as the first servo-controlled axis because its actuator must move 
the largest load and, as a consequence, may create the greatest problems in meeting 
the timing specifications. In what follows, the motor selection procedure detailed 
in Appendix B will be utilized. It is important to understand that if there did not 
exist a complete specification of all of the component weights, it would be necessary 
to start the calculations at the end effector and work backward so as to attempt 
to meet the motion/distance requirements while minimizing the size (and hence | 
the cost) of the 6 axis actuator. However, in the present case, this is not necessary 
since the maximum weights are given for the components. 
| 
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9.3.4.1 axis 


From Section 9.3.3 it is apparent that three separate angular motions are required 
per cycle. The first necessitates a rotation of up to 150° clockwise (from a location 
on the egg carton or 75° from the “bad egg drop-off point,” i.e., the reject site) in 
order to position the fingers of the gripper about the egg. At this time, the z axis 
moves down and the gripper is closed (this action takes about 0.4 s), the z axis moves 
up to the travel height, and the manipulator is rotated approximately 75° (counter- 
clockwise) in order to place the egg within the candling station. After a pause of 
0.05 s, the arm is again rotated counterclockwise (by as much as an additional 75°) 
so that the egg can either be placed in a carton or deposited into the reject bin and 
hence onto the bad egg conveyor. Drop-off requires a 0.2 s pause. These motions 
are summarized in Figure 9.3.3. 


It is observed from this figure that a trapezoidal (or triangular) velocity profile 
has been assumed (for simplicity) and that the acceleration and deceleration times 
are both 0.25 s. Although these times were selected to permit the specifications 
in Section 9.3.1 to be met, the time and motion state diagram shown in Figure 
9.3.2 was also employed to determine the appropriate starting and stopping times 
for each of the three motions required during a single cycle. 

Utilizing the motor selection procedure in Appendix B, it is found that a 


6 Axis Motor 
Speed (rpm) 






1.35 1.6 1.85 2.15 2.4 


t 
(seconds) 





25 .50 .75 .95 1.15 2.6 2.5 3.0 


— 4000 


Move to z Down Move Move to 
Egg Pickup Close Gripper to Egg 
Point z Up Candler Carton 
Candle . | Drop [ z Up 
Egg down off 


Egg 


Figure 9.3.3. Assumed theta axis velocity profile for one complete motion cycle 
(worst case). 
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TABLE 9.3.3 SPECIFICATIONS FOR ELECTROCRAFT 


E-532 

eee 
Property Symbol Value 

eee 

Weight W 3 Ib 

Peak torque Tppag 355 oz-in. 

Continuous stall torque | patel 50 oz-in. 

Armature inertia J 0.063 oz-in.-s” 

Torque constant K; 14.81 oz-in./A 

Voltage constant K 10.95 V/1000 rpm 

Armature/brush resistance R, 2.04 QD 

Armature inductance L, 5.65 mH 

Friction torque T; 3 Oz-in. 

Thermal resistance Ts 4.18°C/W 





motor that will handle the task is an Electrocraft E-532. (This is demonstrated 
below.) Its specs are given in Table 9.3.3. It is important to note that the choice 
of this motor is not unique and that a number of others will perform adequately. 

The selection of the speed-reduction ratio N of the harmonic drive is extremely 
important. A large value of N will reduce the reflected inertia (as the inverse 
square of N). This is clearly an advantage since it means that we can utilize a 
smaller motor to accelerate and decelerate the load. However, as the ratio in- 
creases, more actuator turns will be required in order to reach the (same) desired 
location. For the given timing constraints, this would imply that a very large 
maximum speed would be needed. Also, the power supply voltage would have 
to be larger. 

Once again, after a number of tries, it was determined that a reduction ratio 
of 80:1 would be a good compromise. In addition, it was assumed that a reasonable 
dynamic efficiency » for the harmonic drive was 70%. (For the harmonic drive, 
the range of efficiency 1s usually 40 to 80% and depends on the input speed.)* 

With these considerations as preliminaries, the following calculations can be 
perfomed and the results used as inputs to the motor selection procedure (together 
with the velocity profile of Figure 9.3.3 and the information about the harmonic 
drive): 


1. Reflected Static Torque Load. As there is no torque introduced by gravity 
for this axis, and the bearing and harmonic drive frictions are relatively small, we 


will assume that 7, = 0. 


2. Reflected (Effective) Inertia. We will assume that the 3 lb shoulder (r 





*When the efficiency y of a mechanical coupling device is less than 100%, more torque is required 
in order to accelerate an inertial load. The reduced efficiency causes the motor to “see” a larger 


~ . ‘ ° or . ; 
inertia. This is referred to as the “effective reflected inertia 
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axis) assembly weight acts at the midpoint of the fully extended r axis (i.e., at r, 
= 12in.). Also, the combined weight (3 lb) of the and z axes together with 
the gripper and load is assumed to be located at the endpoint of the reach (i.e., 
r. = 24 in.). Thus we are employing a point-mass approximation. Then the 
effective reflected load inertia is 


_ Wilg)ri_ + (W2/g)r3 
nN? 


— [3 x 16)/(32.2 x 12)](12? + 247) 
7 0.7 x 802 


0.01996 oz-in.-s? 


3. Total Inertia. For the E-532 motor, Jy, = 0.0063 oz-in.-s*. Thus the 
total reflected inertia is found to be 


Jy 


Jr = Ju + J, 
0.0063 + 0.01996 
0.02626 oz-in.-s” 


Note that we have neglected the inertia of the harmonic drive’s wave generator 
and that of the robot’s trunk in these calculations (see Problem 9.8). 


4. Angular Acceleration (and Deceleration). Since the maximum speed for 
the E-532 motor is 6000 rpm, a conservative peak speed in this application would 
be 4000 rpm. Thus the peak angular velocity is 


@) (rpm/60 s/min) x (27 rad/revolution) 


_ 4000. , 
~ 60 " 


= 418.88 rad/s 


pk 


Then the angular acceleration (and deceleration) is 
Wok 
t, 
— 418.88 
0.25 


1675.52 rad/s 





Qa = 


5. Distances Traveled. ‘The final position can be found from the area under 
the velocity curve in Figure 9.3.3. As the profile consists of either triangles or a 
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trapezoid, this is a straightforward calculation. Thus 


a. Move to egg pickup from worst-case position on carton = 


4000_ x_0.5/60 
80 


b. Move to candling station = 


4000 x 0.25/60 
80 


c. Worst-case move from candler to egg carton = 


4000 x 0.25/60 
80 


These angular distances permit the cycle time and distance specifications to 
be met. It is important to note, however, that if larger rotations or a shorter cycle 
time is desired, it may be likely that a different motor would be needed due to the 
larger maximum speed that almost certainly would be required. 


6. Acceleration and Deceleration Torques. During the acceleration and de- 
celeration portions of each phase of the motion, the motor must move the total 
inertia and overcome any joint and/or motor friction. For the constant-velocity 
portion of the profile, the motor must only overcome the friction term. Finally, 
since there is no gravity term in this configuration, the motor torque is zero during 
the pause times. As an example, consider the move to the candling station from 
the egg pickup point. It ‘s assumed that the joint friction as well as all the viscous 
frictions are zero. Thus the only friction term is that due to the motor itself (i.e., 


Ty —= 3 oz-in.). 


x 360° = 150° 


x 360° = 75° 


x 360° = 75° 


‘ = Jy @ + Ty 
0.02626 X 1675.52 + 3 


| 


= 47 oz-in. 
Tsecer = JT & TF T; 
= — 4] oz-in. 
T.. = Ts 
= 3 oz-in. 


alues exceeds the peak torque Treax (i.e., 355 oz-in.), 
d. The overall torque profile is shown in Figure 
for the other two moves during any cycle 


Since none of these v 
the motor will not be demagnetize 
9.3.4. It is clear that Taccet and T gecei 
are identical to those calculated above. 
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Generated 
Torque (oz-in.) 


t 
(seconds) 





Figure 9.3.4. Overall torque versus time profile for the theta axis (only one 
complete cycle is shown). 


7. RMS Torque. To prevent overheating, the developed rms torque must 
be less than the continuous stall torque of the motor (50 oz-in.). For a trapezoidal 
(or triangular) velocity profile (such as that shown in Figure 9.3.3), the calculation 
is quite straightforward because of the piecewise constant nature of the torque 
profile (see Figure 9.3.4). All that must be done in this case is to sum the squares 
of the individual torque segments each multiplied by the corresponding time du- 
ration (i.e., find the area under the torque squared curve).* This sum is then 
divided by the total cycle time and the square root taken. Thus 





3X 0.25 X Taceer + 3 X 0.25 X Tecer + 0.25 X T2y 
2X 0.49 X facet FX 0.29 X Vicor + 0.25 x Ty 


Perms = 3.0 


= 32.2 Oz-in. 


As this is below the continuous stall torque capability of the E-532, the motor 
will not overheat. In this expression the factor of three results from the fact that 
the acceleration (and deceleration) times are the same for all three portions of the 
motion profile. Also, it is noted that we have divided by 3.0 s, the overall cycle 
time. ‘This assumes that there is no delay between candling operations. If there 
is, however, the cycle time must be increased accordingly and the resultant rms 
torque will decrease. 


8. Size of Power Supply. The dc supply that is required to power the servo 
amplifier for this axis must be large enough to handle the back EMF generated by 


*For nontrapezoidal profiles, the rms must be found by squaring the torque curve and then 
performing an actual integration. 
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the motor. For the E-532 running at a peak speed of 4000 rpm, the minimum 
voltage is 


4000 x K 
1000 7 


4 x 10.95 
43.8 V 


In addition, the supply must be able to overcome the resistive drops in the 
armature and wiring. At the peak torque of 47 oz-in., a current of 47/14.91 = 
3.15 A is required. Thus there will be a drop of at least 3.15 x 2.04 = 6.4 V. 
Consequently, a supply of greater than 43.8 + 6.4 = 50.2 V is necessary to meet 
the specifications. If this proves to be impractically large, a different motor winding 
could be utilized that had fewer turns and hence a smaller torque and back EMF 
constant. This would, of course, necessitate a larger peak current (not a problem 
here). It should be understood that 50.2 V is the value that must be supplied to 
the motor terminals. The actual supply voltage will be somewhat larger, due to 
ohmic losses in the cables and the printed circuit boards, the circuits themselves, 
and other distributed power-consuming elements. 


Vegi = 


9.3.4.2 Fr axis 


As mentioned previously, the reach-axis motion will be achieved by having 
a servomotor drive an Acme-type lead screw. We will assume that on average, 
each of the three linear moves will be 3 in. It will be seen, however, that longer 
moves are quite easily accommodated even with the small motor selected. The 
velocity profile for this axis is illustrated in Figure 9.3.5. It is observed that the 


r Axis Motor 
Speed (rpm) 


1800 





: 
(seconds) 





1.9 2.15 2.4 


Figure 9.3.5. r axis velocity profile (one complete cycle). 
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TABLE 9.3.4 SPECIFICATIONS FOR PITMAN 9432 








MOTOR 

Property Symbol Value 
Weight W 7 OZ 
Peak torque TpEAK 13.8 oz-in. 
Continuous stall torque ‘=_- 3.16 0z-in. 
Armature inertia Ju 0.00059 oz-in.-s? 
Torque constant K; 2.2 oz-in./A 
Voltage constant K; 1.93 V/1000 rpm 
Armature/brush resistance R, 1.84 © 
Armature inductance Lig 0.1 mH 
Friction torque T, 0.4 oz-in. 
Thermal resistance Rup 22.7°C/W 





two shorter portions of this profile require higher peak angular velocities since the 
joint is required to move the same distance in a shorter time. 

One motor that will drive the r joint adequately is a Pitman 9432 (winding 
1) and has the specs given in Table 9.3.4. In addition, its diameter is 1.6 in. 

It is found that a lead screw having a pitch P of 2.5 (i.e., 2.5 turns per inch) 
will produce the desired results. A 50% dynamic efficiency is assumed for this 
element (normally, the efficiency range for Acme lead screws is 25 to 85%). 

Calculations similar to those of Section 9.3.4.1 are summarized below. 


1. Reflected static torque. 
T, = 0 (no gravity in the r direction) 
2. Reflected inertia. The actuator only has to move the combined weight of the 
gripper, load, and ¢ axis (i.e., 3 lb). Thus 
_— W/g¢ 
© n(2aP)? 
_ 3.x 16/(32.2 x 12) 
0.5(27 x 2.5)? 


= 0.001007 oz-in.-s2 
3. Total inertia. 


J; = 0.00059 + 0.00159 


0.00218 oz-in.-s2 


Note that this calculation neglects the inertias due to the encoder disk, the 
lead screw (which could be fairly large), and any mechanical coupler. 

From Figure 9.3.5 it is seen that a peak angular velocity of 900 rpm is needed 
during the move from the carton to the pickup point on the conveyor, whereas the 
other two moves require top speeds of 1800 rpm. Utilizing this information, the 
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Generated 
Torque (0z-in.) 


(seconds) 





Figure 9.3.6. Torque versus time curve for the r axis (one complete cycle). 


torque versus time curve shown in Figure 9.3.6 results. Once again it is quite 
simple to calculate the equivalent rms torque from such a diagram. It can be 
shown that the motor must generate T,,,, = 0.80 oz-in. which is about one-quarter 
of what it is capable of producing (i.e., 3.16 oz-in.). Clearly, even a small motor 
such as the Pittman 9432 will have little trouble moving the load and ¢-axis as- 
sembly. In fact, even if longer motions are required, the motor will be adequate 
(see Problems 9.9 through 9.11). | 

Concerning the size of the power supply, it is clear that since K, for the 9432 
is much less than that of the E-532 and also since the peak velocities for this axis 
are also much lower, the voltage requirement of the r axis will be insignificant 
compared to that of 6. Thus any supply large enough to handle the 6 axis demands 
will be more than adequate for the r axis (see Problem 9.12). 


9.3.4.3 ob axis 


The @ or roll axis is needed in order to orient the gripper so that the egg is 
picked up on its long axis. Although angular position is unimportant during the 
candling operation, it is necessary to orient the egg so that the largest end is placed 
on the edge of the appropriate location in the carton. Consequently, we will 
assume that two 180° roll motions are required to achieve this and that the velocity 
profile for the @ axis is as indicated in Figure 9.3.7. 

Using a trial-and-error approach, it is determined that a 10:1 (reduction) 
Simple gear train having a minimum efficiency of about 50% and driven by another 
Pittman 9432 motor will be more than adequate for the assumed task. To verify 
this, it is necessary to calculate the total reflected inertia J,;. This axis js depicted 
in Figure 9.3.8. From this figure it is observed that 


J pears as —— + Sens 
J = X eee 


nN* 
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¢@ Axis Motor 
Speed (rpm) 






1.9 2.15 2.4 


(seconds) 


— 1200 


Figure 9.3.7. axis velocity profile (one cycle). 


For simplicity, we will assume that both the gear train (with gear2 and gear] 
having radii of 1.0 and 0.1 in., respectively, and corresponding weights of about 
1.8 and 0.018 oz) are solid thin disks so that their inertias are given by the expression 
0.5mr?. In addition, the gripper weighs 13 oz and consists of two solid thin disks 
(each of radius 1.5 in.) separated by a maximum distance of 2 in. and we may use 
the results developed in Chapter 3 to find the inertia (recall that the parallel axis 
theorem must be employed in this case). Finally, the 3 oz egg will be assumed to 
be a spherical solid (radius = 1 in.) so that its inertia is found from the formula 
2/5 x mr*. Therefore, we obtain 


0.1 
32.2 x 12 


0.000000233 oz-in.-s* 


J 


g 


cart = 0-5 X 0,018 x 


Egg 





Gripper 


Figure 9.3.8. Details of the axis. The gripper (with an egg) is also shown. 
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J sais = 0.5 x 1.8 x a 
SZ. & 10 
= 0.00233 oz-in.-s2 
mr2 
J gripper = 2x (me — md) 
6.5 1.54 
= 2| ———___ ] ( 2 
(a x 3)( 47 ) 
= 0.05257 oz-in.-s2 
2 12 
de = = Se. 
= 65 (32.2 & 12 
= 0.003104 oz-in.-s2 
and 
.05257 + 0.003104 
J, = 0.000000233 + eS eT Ons 
= (0.001160 oz-in.-s? 
Finally, 


Jr — Ju + J, 
0.00059 + 0.001166 
0.00175 oz-in.-s? 


Utilizing these results, it can be shown that the torque versus time curve is 


that shown in Figure 9.3.9. From this it is found that T... is about 0.48 Oz-in., 


Torque (0z-in.) 


0.84 


0.4 


— 0.04 


(seconds) 





Figure 9.3.9. Torque versus time curve for the ¢ axis (one cycle). 
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which is only about one-sixth of the maximum allowable continuous torque for the 
9432 motor. In addition, the 6 axis power supply can again be shown to be more 
than adequate for this axis (see Problem 9.12 and 9.13). 


9.4 ENCODER SELECTION 


To monitor position, the three servo-controlled axes of the robot (i.e., 0, r, and 
) will utilize optical encoders mounted on the motor end bells. The resolution 
of these encoders must be selected to meet the overall position resolution speci- 
fication of 0.05 in. 

For the 0 axis, it is noted that a 100-line (per revolution) optical encoder will 
produce an output resolution of about 18.85 mils/count ([27/(100 x 80)] x 24) in 


TABLE 9.4.1 SUMMARY OF ROBOT DESIGN FOR EGG 
PACKING/CHECKING APPLICATION 





Parameter ) r p Zz 
Axis reflected 0.02626 0.00218 0.00175 NA 
inertia 
(0z-in.-s?) 

Peak acceleration 1676 754 503 NA 
(rad/s”) 

Peak velocity 4000 1800 1200 NA 
(rpm) 

Peak torque 47 1.6 1.28 NA 
(Oz-in. ) 

RMS torque 32.2 0.80 0.48 NA 
(Oz-in.) 

Encoder resolution 100 100 100 NA 
(lines/rev) 

Gear reduction or 80:1 pha | 10:1 NA 
L.S. pitch 

Axis resolution 18.85 4.0 9.4 NA 
(mils/count) 

Maximum + 90° 18—24 in. + 180° 2 in. 
excursion of 
motion 

P.S. requirements, 50.2 P P NA 
(V) | 

P.S. requirements, 3,15 P P NA 
(A) 





P, homework problem; NA, not applicable (z axis is pneumatic bang-bang, 
nonservo). 
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the worst case (i.e., with the r fully extended to 24 in.). Note that the factor of 
80 results from the speed reduction provided by the harmonic drive. As will be 
seen, this 1s more than adequate for meeting the resolution spec. | 
| Concerning the resolution of the r axis, a 100-line optical incremental encoder 
will yield a value of 4.0 mils/count [i.e, 1/(2.5 x 100)]. Thus the reach axiS 
contributes considerably less to the overall position resolution of the load (the egg). 
Finally, if a 100-line optical incremental encoder is used and one includes the 
effect of the 10:1 gear reduction, the resolution of the ¢ joint will be about 9.4 
mils ({211/(100 x 10)] xX 1.5 in.). Thus the overall resolution of the robot (i.e., 
32.25 mils) is well under the 50-mil spec. 
A summary of the robot design is given in Table 9.4.1. 


9.5 COMPUTER ARCHITECTURE AND CONTROL STRUCTURE 


have three servo-controlled axes and one bang-bang, 


As discussed, the robot will 
essor structure described in Chap- 


nonservo axis. For this purpose, the multiproc 
ter 4 can be utilized for the servoed joints. Thus three separate joint (slave) 


processors along with a master (and perhaps a math coprocessor) will be required. 
It is also certainly possible that a single microcomputer could be used to handle 
the tasks of both the master and slaves (and perhaps even the math processor). 
The reason for this is that the geometry of the robot is fairly simple and extremely 
rapid and smooth motions are not critical in this application. In addition, the reader 
is encouraged to review the material presented in Section 7.8 where a model of a 
robot’s computer system is discussed. Figures 7.8.1 and 7.8.2 are especially im- 


portant in this respect. 


Concerning the control structure, a PD control would be required at the very 


least. It is also possible that even though there is no disturbance due to gravity, 
friction will produce undesirable position errors. An integrator might then be 
required to compensate for this effect (1.e., 4 PID controller would be required 
for each joint). As discussed in Chapter 4, this device would be realized digitally 
in the software associated with the individual axes. 

A small power amplifier would be needed to drive the r and 0 axes. However, 
the @ joint would require a good-sized one capable of outputting at least 51 V at 
3.5 A (i.e., almost 180 W). This is certainly not impossible, although the cost 


for such a robotic device. 
might be higher than wou lly actuated (i.e., nonservo bang-bang), 
Even though t 


he z axis 1s pneumatica | ns' ) 
binary sensors should be incorporated to indicate when the axis is up and when it 
is rin These sensors would ensure that the axis 1S up before the manipulator 
begins to move and down before t dor closed. In addition, the 


he gripper is opene 
gripper itself could incorporate sensors to inform the controller when an egg has 
been successfully acquired oF dropped off. 


be warranted 
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9.6 VISION SYSTEM CONSIDERATIONS FOR THE EGG PACKER 


Recall that vision is to be used for two different purposes. The first is to locate 
the egg (on the conveyor) and the second is to test for the presence of an embryo. 
Note that two separate vision systems may be required to accomplish these tasks. 

There are many considerations that are involved in selecting vision or photo- 
optical sensors for the egg packer/rejection system. These include: 


e Vision system resolution 

e Camera selection 

e Photo-optical interrupter to stop the conveyor 
e CCTV for egg location and orientation 

e Colorizer/density measurement system 

e Vision system calibration 


Each of these will be treated in separate paragraphs for clarity, and where 
appropriate, pseudocode will be used to explain the authors’ version of a solution. 
The reader is invited to be creative and establish personal solutions to the problems 
that will be posed. 


9.6.1 Resolution 


The area of the conveyor that is imaged by the CCTV is approximately 6 in. x 6 in. 
The pickup accuracy of the end of the arm tooling (i.e., at the robot’s gripper) is 
about +50 mils (actually, +32.25 mils). From this information, the pixel density 
required can be computed as follows: 


pixel density = resolution 
_ linear extent 
pixel density 
— 6000 mils 
50 mils/pixel 
= 120 pixels 
This calculation shows that a video digitizer of 120 x 120 pixels will be 
sufficient to locate the egg to within +50 mils. It is left as an exercise for the 


reader to determine the angular accuracy to which the egg’s orientation can be 
found. 





a tie . ae — 
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9.6.2 Camera Selection 


The selection of a camera for this application depends on several requirements. 
These include: 


Resolution 
Linearity 
Gray-scale 
Acquisition speed 
Synchronization 





Each is now discussed briefly. 


9.6.2.1 Resolution 


As has just been calculated, a resolution of 120 x 120 pixels is required to 
achieve the desired accuracy. Referring to the vision chapter (Chapter 6), it will 
be noted that standard RS-170 cameras have 525 lines per frame. If the camera 
is noninterlaced, there are 262.5 unique lines for imaging. These standard devices 
all have sufficient resolution for this application. Thus, practically any commer- 
cially available tube or solid-state RS-170 camera may be used based on the res- Bi | 
olution requirement. et 

In addition to RS-170 cameras, there are several manufacturers of specialty | 
non-RS-170 solid-state cameras that have resolutions of 128 x 128 that would be j 
sufficient for this use. These units would be adequate for this application but are 
more expensive, since the market for them is not as large as for RS-170 standard 
CCTV cameras. One would use such a solid-state device if other factors, such as 
acquisition speed or synchronization with external events, are important require- 
ments. These nonstandard cameras are able to acquire images faster or slower 
than RS-170 cameras, and may be required if ambient-light conditions are poor, 
if higher-speed response is needed, or if reduction of motion blur artifacts is im- 
portant. 

With regard to resolution, virtually any commercially available two-dimen- 
sional imaging camera is Satisfactory. Others, such as line array devices, are 
inappropriate here because of additional expensive accessories that would be re- 
quired, such as specialized lighting systems Or mechanical transports for scanning 
the image orthogonally to the sensor’s line-scan direction. 


8 ROE ad VES ~ 


9.6.2.2 Linearity : \ 


No scanning device of any nature has perfect linearity. In the application ti | 
being considered, the linearity of concern has to do with the accuracy of the scanning 
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performed to acquire photo-optical information from the sensor. Solid-state sen- 
sors are manufactured using photolithographic processes and will generally be 
spatially correct to within 5 wm (millionths of a meter). The actual size of the 
photosensor is approximately 8.8 mm. Thus the solid-state sensor can hold a 
position placement of approximately 1 part in 1800 (0.05% accuracy) Over the 
target area. This precision is generally swamped by lens and electronics inaccur- 
acies. Tube-type cameras (e.g., vidicons) have more nearly continuous photo- 
sensitive material, but the scanning electronics introduces from 1 to 5% distortion 
in pixel placement accuracy, with the higher distortions generally being on the 
periphery of the field of view. 

In this application, the resolution requirement of 50 mils over a 6000 mil field 
of view results in a 0.833% specification on resolution, so a solid-state camera is 


the preferred choice, since a tube-type camera of moderate cost will perform 
marginally. 


9.6.2.3 Gray-scale 


The gray-scale requirements of this application may be analyzed relative to 
the two separate vision requirements, first locating and then candling the egg. 
These will be treated as separate constraints. 

Location of the egg can be accomplished by using an appropriate illumination 
system to create a binary image. Either toplighting or backlighting will permit 
this to be accomplished easily. Thus the camera will need to resolve only two 
gray levels. ‘This requirement is easily met by any commercial CCTV camera. 
Solid-state sensor devices generally have 6- to 7.5-bit gray-scale resolving capabil- 
ities, whereas tube-type cameras generally have 4 to 5 bits of gray-scale resolving 
ability. It should be noted that television standards require only 10 gray levels (3 
to 4 bits) for acceptable television imaging for viewing by human beings. 

The candling application, however, requires detection of faint shadows of the 
embryo, its coloration, and its shading to be detectable. Since this requires dif- 
ferentiation of subtle amounts of a few percent changes in transmittance, the sensor, 
must be able to distinguish many gray shades. Since solid-state sensors will be 
able to provide between 0.5 and 1.5% gray-scale resolution and tube-type sensors 
will provide between 3.125 and 6.25% gray-scale resolution, the former camera 1s 
the logical choice. Another benefit of the solid-state sensor is that it typically has 
a higher response in the red end of the visible Spectrum than the tube types. Since 
the candling operation to some extent will depend on blood specks around the 
embryo, the solid-state camera has yet one more advantage over the tube type. 


9.6.2.4 Acquisition speed and synchronization 


For this application, there are no s 
conditions, so either a solid-state or tube 
noted, however, that when both are oper 


pecial requirements in regard to these 
“type camera will suffice. It should be 
ating at 60 Hz in a noninterlaced mode, 


= 
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they will require between 16.67 and 33.33 ms to acquire animage. The explanation 
of this is left as an exercise for the reader (see Problem 9.15). 

Although not relevant here and well] beyond the scope of this presentation, 
in some circumstances it is important to be able to synchronize the image acquisition 
to external events. In such cases, special electronically or mechanically shuttered 


cameras or stroboscopic illumination techniques are frequently used to solve these 
problems. 


9.6.3 Photo-Optical Interrupter 





The conveyor is used to bring eggs into the field of view of the CCTV. A simple 
photointerrupter will be used to stop the belt at the appropriate placement of the 
egg approximately halfway into the field of view of the CCTV. Pseudocode for 


the conveyor controller that may be translated into a computer program is given 
in Table 9.6.1. 


9.6.4 CCTV for Egg Location and Orientation 


The CCTV will be interfaced to a video digitizer whose output will then be processed 
by an appropriate software program. The pseudocode presented in Table 9.6.2 
may be used to construct such a program. 


9.6.5 Colorizer/Density Measurement System 


The candling system that is needed must be able to detect changes in the density 
or color of the egg when it is transilluminated by a yellow/orange light (i.e., a 
“candle’’). Blood formed in the embryo will absorb relatively more of the candle’s 
light spectrum and the egg will appear relatively darker. A possible configuration 
for such a system might contain a bright light source in the end of arm tooling. 


| 
4 
; 
i 
] 
h 


TABLE 9.6.1 CONVEYOR PSEUDOCODE 


lf "MOT REQ" = TRUE >; "MOT REQ" = internal flag i! ¢ 
Then MOVE BELT f 
Until VISION O = TRUE ; VISION 0 = processed | 

Set "MOT REQ" = FALSE ; result of photo-optical 


; interrupter ag 
Cr : 
Note: moT REQ@ = TRUE if cell controller says OK, i.e., field of 
CCTV is clear AND another EGG is needed 
MOT REQ = FALSE when an egg is in the CCTV field of view. 
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TABLE 9.6.2 PSEUDOCODE FOR OBJECT ID, ORIENTATION, AND PICKUP 
i ante re 


Compute A = area of egg 
P = perimeter of egg 
X = major axis of egg 
Y = minor axis of egg 
C x,y ] = centroid of egg 
>; IDENTIFICATION SECTION 
If A NOT within size limits THEN OBJECT = FALSE 
i, <P NOT within size limits THEN OBJECT = FALSE 
If P*P/A NOT within size limits THEN OBJECT = FALSE 


Else OBJECT = TRUE 
;ORIENTATION SECTION 


Compute Angle of Major Axis 3; Arctan CY/X) 
;PICK-UP SECTION 

Compute Centroid ; £ x,y J 

END 





The light will be activated as the arm brings the egg over the candling test point. 
A measurement of the brightness of the light passing through the egg will be used 
to accept or reject the egg. 

It is left as an exercise for the reader to propose a specific candling system 
and a specific sensor to be used as well as the determination of the accept/reject 
logic. Among the things that should be considered in selecting such a system are: 


e Resolution of the sensor 
e Type of sensor (point, line, array) 
e Normal density determination (i.e., statistics) 


9.6.6 Vision System Calibration 


The CCTV vision system must be calibrated and referenced to the robot coordinate 
system. Obviously, this should be done only after the robot has performed its 
own calibration routine. Vision calibration can be accomplished by moving the 
robot arm into the field of view of the CCTV and locating it at two separate 
positions. A test pattern stenciled onto the end of the arm can be used to pinpoint 
it by the vision system. For example, a high-contrast ‘““+” on the end of the 
manipulator would be a convenient fiducial mark for the vision system to locate. 
The robot would be programmed to move the ‘“‘+” mark to a specific portion of 
the field of view (e.g., the upper left corner). Then the vision system would be 
programmed to locate the “*+” mark. The robot would then be commanded to 
move to another portion of the field of view (e.g., the lower left corner). The 
vision system would then locate the mark again. 
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Once the vision system has determined the two arm placements, a simple 
coordinate transformation may be used to relate the two frames (i.e., vision frame 
and robot frame), thus allowing for the vision coordinates to be translated into the 
robot system coordinates for egg pickup and subsequent placement. In particular, 
we will have 


R=TIV+0O 


where R and V are, respectively, the robot and vision frames, T is the linear matrix 
transformation between them and O is the system offset. This procedure relates 
the vision frame to the robot frame, in pixels. 

The relationship of the pixels to actual dimensions must also be known. This 
is best done by placing a test object of known size (e.g., a disk of known diameter) 
in the field of view, and then having the vision system measure the length of the 
object at several places, several times, and then computing the pixel-to-distance 
calibration (see Problem 9.16). 


9.7 SUMMARY 


This chapter brings together many of the techniques and technologies that have 
been discussed throughout this book. Obviously, one moderately simple example 
cannot illustrate all the material presented. The solutions given are suggestions 
and the reader is challenged to create different (better?) solutions to the design 
and implementation of an egg packer. For example, one may choose to sort the 
eggs by size or color (e.g., brown versus white eggs). One may also choose to 
inspect the eggs for hairline cracks. The reader is also encouraged to construct a 
working model of the egg candler/packer robot, since in this way a true appreciation 
of the problems associated with robotics and its associated technologies can be 


developed and appreciated. 


9.8 PROBLEMS 


ation for the egg packing task described in Section 9.2. Make 
ll pertinent system considerations, such as speed of the conveyor 
ize of cartons, and so on. Do not make trivial assumptions 
the conveyor belt is constant, without adding tolerances: for 
conveyor belt is constant to within + 1 cm/s.”” The 
lete enough so that a co-worker would be able to draw a 
flowchart of the process OF construct a procedure for accomplishing the task. Pay 
attention to material-handling assumptions on parts entering and leaving the workcell. 
9.2 a. Draw a structured procedure for completing the processes in Problem 9.1. The 
procedure should be able to be given to a fellow worker who should be able to 
complete the task from this procedure. You must use Figure 9.2.2 and assign 

| dimensions to the room layout. 


9.1 Complete a specific 
assumptions about a 
belt, weight of an egg, § 
such as that the speed of 
example, “the speed of the 
specification should be comp 


reasonable physica 
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9.3 


9.4 


9.5 


9.6 


9.7 


9.8 


9.9 


9.10 


9.11 


9.12 
9.13 
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b. Design at least two separate procedures, one utilizing a vision system capable of 
locating the egg on the conveyor belt, and one utilizing no vision system for location 
but incorporating a mechanical workpiece that can orient the eggs for pickup. 


(Optional) Construct a wooden model (to size) of the robot mechanism and the me- 
chanical gripper and sizing mechanism. Build the model so that the r, 0, , and 2 
axes and the gripper may be manually moved into the proper position for parts handling. 
Work on a tabletop that simulates a conveyor, and use cardboard construction material 
to simulate vision sensors and other details. Place an incandescent bulb at a Strategic 
place so that a simulated illumination source is available. Using this mock-up, follow 
your procedure developed previously, and walk through each process step. Based on 
this simulation, prepare a list of the weak points of your procedure. Correct or modify 
your procedure based on this walkthrough, and then allow a co-worker to run through 
the process without your prompting. How did your modified procedure hold up under 
this scrutiny? What are your conclusions? 


For the room layout that you have constructed, specify the location required for a ° 
vision system and a robot having cylindrical coordinate geometry. This r, 0, , and 
z robot will also need end-of-the-arm tooling, so specify an appropriate workholder 
for gripping the egg, candling it, and placing it in the carton. 

Assuming that it is desired to move the egg in an uncoordinated motion path from any 
point in space P; = (x, y,, z,;) toany other point P,; = (x5, y>, Z>), describe the control 
algorithm for accomplishing this action. Assume the simplest possible control algo- 
rithm that you can think of. Using reasonable motor constants, such as the ones 
suggested in the text, and assuming that dc servomotors are used to drive the r, 0, and 
axes, describe the profile of each motor axis output. What is the Cartesian space 
path that will be traversed? 


Assuming that coordinated motion is to be accomplished in a straight line from P, to 
P, in Cartesian space, derive the r, 8, and ¢ drive signals for this requirement. Make 
sure to consider the work volume of the robot so that unreachable zones are not 
traversed. 

Detail the interface signals and the information required among the following sub- 
portions of the problem: 

a. Interface between conveyor belt and robot controller. 

b. Interface between robot controller and vision system. 

c. Interface between egg carton output stage and robot controller. 


Repeat the @ axis calculation and motor determination if the inertia of the harmonic 
drive wave generator is 0.01 oz-in.-s?. 


Show that 7,,,, is approximately = 0.80 oz-in. for the r axis of the robot designed in 
the text. 

Assuming that all three distances for the r axis are the same during any cycle, determine 
the largest distance that can be achieved utilizing the Pitman 9432 motor. Assume a 
cycle time of 3 s and that all other times are unchanged (in Table 9.3.2). 

Repeat the r axis calculations if an additional inertia of 0.002 oz-in.-s? due to the 
encoder disk and coupler is assumed, 

Find the peak and rms torques for the ¢ axis. 


Determine the maximum power supply required by the r and o axes and demonstrate 
that in both cases it is much smaller than that needed to drive the @ axis. 


Sec. 


9.14 


9.15 


9.16 


9.17 


9.18 


9.19 


9.20 


9.21 


9.8 Problems 693 


Detail a structured algorithm for the vision system so that the standard processes 
described in Chapter 6 can be used to accomplish the job. Be careful to describe the 
video servoing necessary to locate the egg on the conveyor belt, and also consider the 


problems of differentiating between a brown and a white egg, and whether or not it 
has an embryo in it. 


Show that the acquisition time from a random external event, for an image from an 
RS-170 CCTV camera operating in a noninterlaced fashion, is between 16.67 and 33.33 
ms. What are the average and standard deviations of the acquisition time? 


Why is a disk of known size a good test object for calibration of the pixel-to-distance 
ratio for a camera and image acquisition system? Describe a set of algorithms in a 
pseudocode form to perform the calibration of a vision system, especially considering 
the possibility of having different calibrations for the two axes. 


Based on the resolution of the encoders chosen for the r and @ axes and the assumption 
that position is maintained within +1 pulse of the set point for an arbitrary location 
in space, compute the worst-case error. How would you reduce this error by a factor 
of 2? Be sure to include the effects of the axis in your analysis. 

Consider the effect of the inertia of the lead screw used in the r axis. Assume that 
the steel screw is an ideal cylinder that is 7 in. long and weighs 16 oz. Find the radius 
and inertia of the lead screw. Use the result to determine the peak and rms torques 
that must be developed by the Pitman motor. Is this actuator still adequate? 


Suppose that the time to perform steps 7 and 8 and also steps 10 through 12 in the 

motion sequence Table (9.3.2) is reduced from 500 ms to 374 ms. Recalculate the 

peak and rms torques that must be generated by the 6, d, and r motors and determine 

whether they are “‘adequate.” If so, is it still possible to reduce the cycle time still 

further? 

Using the procedure illustrated in Example 8.7.1 as well as some of the relationships 

derived therein, obtain the forward and inverse solutions for the manipulator shown 

in Figure 9.3.1. 

Using Figure 3.10.2 as a model for the r—9 axes of the manipulator of Figure 9.3.1 

and the velocity profiles shown in Figures 9.3.3 and 9.3.5: 

a. Compute the required torque (@ axis) and force (r axis) as a function of time using 
Eqs. (3.10.10) and (3.10.11). 

b. Based on the results of part a determine if the motors selected are satisfactory in 
terms of peak and rms torque ratings. 


Appendix A 


Specifications of Commercial 


Robots 


The following table lists some of the commercially available robots and describes 
their specifications as supplied by their manufacturers. The manipulator industry 
is in a rapid state of flux and the reader is cautioned that this table should be 
considered a rough guide. In using this table the reader should keep in mind that: 


1. 


2. 
J 


6. 


os 


Also, “‘opt 


The performance characteristics quoted in the table may not actually be 
achievable. 

Not all manipulators listed in the table may be available. 

There is a wide variety of capability between manufacturers in regard to both 
current and potential future customer Service. 

Some of the manipulators have undergone little, if any field testing and 
development. Some may be shipped without adequate (at least 50 hours) life 
testing in the factory. 

Some manufacturers may not carry a large inventory of spare parts. Others 
may be out of business in the near future. 

This list is not complete and additional models (from these and other com- 
panies) are available. 

Entries with an asterisk (*) are no longer being made. 


» in the table means the feature or axis 1S optional. 
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Appendix B 


Motor Selection in the Design 
of a Robotic Joint 


B.0 MOTIVATION 


After the mechanical structure of a robotic manipulator is determined, a suitable 
scheme for producing motion must be developed. This will usually include the 
specification of mechanical couplers and/or drives (e.g., gear trains, harmonic 
drives, etc.) as well as the actuators themselves. A discussion of the former is 
found in Chapter 3. In this appendix we are concerned primarily with developing 
an organized method for selecting the servomotors that drive the individual joints 
of a robot. What is to be presented here is by no means the only way to handle 
this problem but instead represents a conservative approach which ensures that 
the motor selected will not exceed physical limitations of any of its parameters. 
As such, this appendix is intended to act as a guide (hopefully useful) to people 
“just getting started.”’ Most certainly, readers are encouraged to expand on this 
material and develop their own techniques. 


B.1 INTRODUCTION 


In the following procedure all load quantities, such as moment of inertia J i» Viscous 
damping B_,, and noninertial, nonviscous torque I’, (representing either a load or 
a disturbance), together with coupling quantities such as moment of inertia and 
damping, are assumed to be referred to the motor shaft. See Chapter 3 for a 
discussion of how such calculations are performed. In addition, it is assumed that 
the designer has compiled a list of motors (and their parameters) arranged in 
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ascending order of unit cost. Ifa particular motor has more than one winding 
available from a manufacturer, these windings will be arranged in ascending order 
of torque constant, K;.* A sample of such a list is given in Table B.3.1 at the end 
of Section B.3. Furthermore, it is assumed that the motor parameters included 
are those normally specified by manufacturers at room temperatures (e.g., 25°C) 
so that no active cooling such as fans is considered. 


The calculation procedure to be described is divided into four sections: 


A. Peak and maximum continuous torque calculation 
B. Peak current calculation 


C. Armature temperature calculation 
D. Power supply peak voltage requirement 


If, in any of these sections, a particular condition is not met, the designer 
must go back to the list of motors and change some or all of the motor parameters 
by either selecting another motor on the list or another winding for the same motor. 

A flowchart of the entire procedure from which a computer program could 
be written is given in Section B.4._ An example that makes use of this process is 
presented in Section B.5. The final section includes a list of preferred units used 
in the procedure and factors for converting other units that are often encountered 
to the preferred ones. 

Before beginning the process of motor selection in a particular problem, the 
following quantities must be specified by the designer: 


= peak motor shaft angular velocity (rad/s) 
t, = acceleration time (s) 
constant velocity time (s) 
t, = deceleration time (s) 
t, = dwell time (s) 
J, = load moment of inertia (oz-in.-s”) 
B, = load viscous damping (oz-in.-s/rad) 
T, = applied load torque (noninertial, nonviscous, and assumed 
constant) (0z-in.) 
0...» = ambient temperature CC) 
Ips... = Maximum power supply current (A) 


Ves... = Maximum power supply voltage (V) 


In addition, the load speed versus time profile is assumed to be trapezoidal, as 
shown in Figure B.1.1 and is also referenced to the motor shaft. The reader 


eee 


*It is important to note that one could also use peak or rms torques as a method for ordering 
the motors. 


tIt is assumed here that the robot joint (the load) and the motor have the same velocity profile. 
That is, the coupling transmission permits them to move in phase with one another. 


— ee 
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w(t) =6 

Wok 
etc. 
+ ty ————+>| 
t 
a t, + tey te t+tytt, tatty +t, + ty 
(a) 

a(t) = c(t) 






tattytt +t 


(b) 





titty +t +ty 


(c) 


Figure B.1.1.: (a) motor shaft angular velocity profile (trapezoidal); (b) corre- 


sponding angular acceleration; (c) torque profile assuming a constant load torque. 
Here 
+ ee + ae. = a 4+ Ge 
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should understand that this assumption is made for computational convenience since 
the associated acceleration is then a piecewise constant function of time. Thus 
calculation of the rms torque is easily done in closed form. See, for example, 
steps 2 and 3 in Section B.2.1. When, as is often the case, it is important to have 
a smoother velocity profile during the acceleration and deceleration phases, the 
rms torque must then be calculated by integrating the square of the torque versus 
time curve over the appropriate time interval(s), dividing by the time period (con- 
sisting of the total motion time plus any resting or ‘“‘dwell’’ time t,), and taking the 
square root of the result. 


B.2 STEP-BY-STEP PROCEDURE FOR SELECTING A SERVOMOTOR 
B.2.1 Peak and Maximum Continuous Torque Calculation 


1. Assume: the motor parameters are all zero (i.e., Jy, = Ty = B = 0). There- 


fore, 
Joa = Ju t+ Jr = Ji 
Bom = B+ By, = B, 
fT wit = T; ey T, = T, 
Compute: 


| Ps = Ji Qaccel a ‘e + B, Wok 
Ji M%ox 


= T, + By wp. 


a 
TW. = T, T BW 
| = J L Adecel T, 


Tawen = T, 





Ed aed z3 al os + Pes E taT Gwen 
t, + ty +t+ t 


2. Enter the LIST OF MOTORS (at winding number 1) (see Table B.3.1). 
Select the Jeast expensive motor that satisfies all of the following conditions: 


(a) Tpeak od Piece 
(b) TpEAK x acces (B.2.1) 
(c) (a a > ‘a 
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3. Get Jy, T,;, and B from the list of motors for the motor selected in step 2. 
Recalculate Tyee, Tey, Teco, and T,,,, as follows: 
W 


pk 
la 





Taccer = (Sy + Jz) + T, + (B + B,) oy, + T, 


S 
| 


= ler (B+ By) Og + Tz 


Wok ) 
T decei ae Ju + Ji) ~~ = Ty — Ty 


T — bl acces =F bah co 7 tT Gecet i tyT awe 


sms t, + ty tt + ty 


4. Check inequalities (B.2.1) in step 2. If the new values of Jy,, T;, and B do 
not produce a motor change, this motor satisfies the peak and continuous 
torque requirements. Then proceed to step 5. If inequalities (B.2.1) are 
not satisfied, move to the next motor on the list of motors and repeat steps 
3 and 4 until there is no motor change required [i.e., inequalities (B.2.1) are 
satisfied]. Then proceed to step 5. 


B.2.2 Peak Current Calculation 
5. For the motor selected in step 4, obtain the K; (the torque constant) and 


Tjemag (the demagnetization current) for the appropriate winding number and 
compute the peak current as follows*: 














‘ 
ar a 
x 
7 = |fe 
, = |e 
Kr (B.2.2) 
L = co 
y & 
Ipeak = max value [J,, L, 1] 


*Servomotors that employ rare earth magnets (e.g., samarium cobalt) usually have extremely 
large demagnetization currents which are virtually impossible to exceed during acceleration or decel- 
eration of a motor shaft. In fact, for such motors, Jgomag is normally not even specified by the man- 


ufacturer. 
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6. Is [peak < Liemunt” If yes, go to step 7% Ht no, move to the next motor 
on the list of motors and repeat steps 3 through 6 [checking inequalities 


(B.2.1) in step 2 each time]. When inequalities (B.2.2) are satisfied, go 
to step 7. 


7. Is IpEaK < FSmax? If yes, go to step 8. If no, stay with the motor selected 
iy BEE 6 until LpiaK < [singe Now go to step 8. If all the windings are 
tried and /pp ax is still greater than Ips... Move to the next motor on the 


list of motors (using winding 1) and repeat steps 3 through 7 [checking 


inequalities (B.2.1) and (B.2.2) each time] until Jppax < /ps,,,,- Then go 
to step 8. 


B.2.3 Armature Temperature Calculation 


8. Compute:+ 


lm = 
K; 
RI ie Rey 


6... ———_——————. = armature temperature rise above ambient 
We T= Reng Rey Y ' 


rms 


ion = O94 + Qari 


where wW = resistance temperature coefficient = 0.00393 (copper wire) 
= 0.00415 (aluminum wire) 
R, = armature winding resistance plus terminal resistance (at 25°C) 
R,, = armature to ambient thermal resistance 


9. IS Oarm < Oarmmax? Lf yes, goto step 10. If no, move to the next winding 
for the motor presently being used and repeat steps 5 through 9 until 6, 
< Om... Now go to step 10. If all windings for this motor are tried and 
O..m iS still greater than ®armma» MOve to the next motor (using the first 
winding) and repeat steps 3 through 9 until 9.41 < ®amma: Then go to 
step 10. 


*For rare earth motors, some arbitrarily large value of (jcmay Can be used in the list of motors 
so that step 6 can still be performed. Here, however, the ‘‘answer”’ will always be yes. 


tHere it is assumed that the motor is mounted on a “suitable” heat sink. Often, this is specified 
(by the manufacturer) to be a block of metal 10 in. x 10 in. x 1/4 in. or equivalent. If this is not so, 
the motor temperature will be higher or lower than calculated. 
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B.2.4 Power Supply Peak Voltage Requirement 


10. Compute: 
R,, R,|1 + U(G2rm i” 25)] 


“hot” value of the armature resistance 


N, = 9.593 X 1073 wy 


motor shaft speed (1000 rpm) 


V; = R, 1, + KEN, 
Verak = max. value V, = R,L + KN, 
V3 = Rplz + KEN, 


M1. Is Vopax < Vps,,,.? If yes, go to step 12. If no, move to the next motor on 
the list of motors and repeat steps 3 through 11 [checking inequalities (B.2.1) 
and (B.2.2) each time]. Repeat until Vpgpan < Vps,,,. Then go to step 12. 

12. Record the motor number, manufacturer’s name, winding number, cost per 
unit,all Other parameters, 6,... Tecan, Vocan, Ipecac, anid Lo. 

13. Stop. 


B.3 MOTOR SELECTION PROCEDURE: FINAL CONSIDERATIONS 


The reader should note that torque constant Kis temperature sensitive and should 
be derated as follows: 


K; = Kr [1 _ B(O,nagnet 7” 25°C)] 


where 8 = torque constant derating factor = 0.002 (ceramic mag- 
nets) = 0.005 (alnico magnets) 
Onagnet = Maximum motor temperature = @ 


arm 


This change in Ky will especially affect the demagnetization current check 
(step 6) but will become important only when 6,,_. is near the maximum allowable 
value (often 155°C). Under these conditions, it may be wise to select the next 
motor on the list of motors. In fact, for safety sake, this would be good practice 
whenever 9.1m, /peax» Vezax, Tpeax, and/or T.,.. are near the maximum values 
for the motor selected using the procedure. Note that this could automatically be 


built into the procedure by derating Vp,__ and J PSmax ANd increasing 0,,,,,, (and some 
or all of the load parameters by 10%, for example). " 


It is worthy of note that in steps 10 and 11, where th 
voltage requirement is determined, it is assumed that there are no voltage drops 
in the cables that connect the supply to the motor armature terminals. In practice, 
however, the nonzero resistance of the wire produces a small to moderate (1.¢:, 


€ power supply peak 
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1 to 5 V) reduction in the voltage actually reaching the motor. Consequently, it 
is necessary to take this into account when sizing the supply. The effect of ohmic 
loss can also be minimized by paralleling two or more wires, thereby reducing the 
current that each has to carry and hence the voltage drop. A sample list of motors 
is shown in Table B.3.1. 


B.4 FLOWCHART OF MOTOR SELECTION PROCEDURE 


A flowchart of the 13-step procedure described in Section B.2 is shown in Figure 
B.4.1. It is also necessary to have compiled a data base which lists a variety of 
servomotors that are currently available from different manufacturers. Called the 
list of motors, this data base must be updated periodically for the procedure to be 
most effective. 


B.5 EXAMPLE 


To illustrate the use of the procedure described in Section B.2, let us find a motor 
that will move a weight a short distance in a linear fashion very rapidly. Note 
that such a situation is analogous to a robotic prismatic axis. It is assumed that a 
lead screw is employed as the mechanical drive between the motor and load. The 
specifications for this problem are given below. 


Problem Specifications 


W, = weight of load to be moved = 188 oz 
P = lead screw pitch = 5 turns/in. 
n = lead screw efficiency = 1 (i.e., 100%) 
Lis = lead screw length = 6.15 in. 


ris = lead screw radius = 5/16 in. 
AX = linear displacement of load = 0.060 in. 


t, = t, = 0.015 s 

t.. = 0 

T, = total lead screw friction = 10 oz-in. 
B, = 0 


In addition, it is assumed that the motion duty cycle is 100%, so that the dwell 
time ta = Q. 


B.5.1 Preliminary Calculations 


1. Lead screw moment of inertia, J, < 
Weight = volume x density = r?,L,sp,<s 


prs = 0.28 Ib/in.2 = 4.48 oz/in3 










READ ty, te 
Woks t, t,, Ju B. 


SET: Ju=T;=B=0 
N,=1, mLp=1 





7) 
Taceal = JL — + Th + B. Wok 
Tee = in + B. Wok 


Towel = T, 













7) 
Taecet = Ji - = By Wx 


te Teoce + tev 12) + ts Faecet + ta TE wet 
tLt+tytt+t 


ENTER MOTOR LIST 












Tpeak > Taccel 
Tpeax > Tdecel 
5 er Be > Pe 


= 2) 
GET: Su. 16 B, Tpeake (Tcorit) max 


é) 
Texte = (Sug + JL) St TH (B+ Bile, + Te 


INCREMENT mLp 





















ENTER MOTOR 


LIST Tey =T;+ (B+ By) px + Th 


G@) 
Trecet = (Sm + Je) . —T,—(B+ By) &—Th 


Toe = (te T2ocat + tev Tev + te Tdecet + ta Tewett) / (t, + tey + t, + ty) 


Figure B.4.1. Flow chart for motor selection procedure. 
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INCREMENT 
mLp 


ENTER MOTOR 


LIST 
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GET: KE, Kr, R,, Rtn, v 





ldemagr N 0 


Wmax! ~ 8M max 










ly = Taccei/ Kr 
lb=Tey/Ky 
l= Telecel? Ky 


lpeak = Max {l,, I, I} 


NO 
IpEAK > Idemag 


lis = Trma/ Ky 
Ra Reinlns 

1 Ry Rinl2ne¥ 

8 arm = Srise + Damb 


YES 


Figure B.4.1. 



















GET: K;, .™ Ke 


Siemnag 


NO 
YES 
INCREMENT 
mLp 


ENTER MOTOR 
LIST 


Sec. B.5 Example Jin 


Ry = Ral 1 + Y 18am — 25]) 
N, = 9.5493 x 10-35, 
V; — RI, + KeN, 

Vo = Rilo ap KeN, 

V3 = Ry ls + K_N, 





Veeak = {V3, V2, Va} 


Vpeak > VPSmax 


PRINT 
Motor Number, Cost, 
— Winding Number, All 


Motor Parameters, 
Manufacturer, @mnax, 
lpcaks Vpeake Tpeaks Vins 





ENTER MOTOR 
LIST 


Figure B.4.1. (continued). 


| 


Weight, = 7 X (5/16)? x 6.15 x 4.48 = 8.45 oz 


weight; s 8.45 
— —2 = = —— = 0.0219 oz-s?/in. 
Mis g 386.09 oz-s*/in 


Jis - 0.5 Niet & — 0.001069 Oz-in.-Ss2 
2. Load equivalent moment of inertia, J, 


Peli ae 
n(2mP)* 


_ 188/386.09 
~ 1[2n(5)P 
0.000493 oz-in.-s” 


= 
I, = 
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3. Peak motor shaft angular velocity, w, 
2 x (2mP) X AX 
i. = 2 
t, + 2t. + t 
_ 2 X 2n(5) x 0.06 
0.015 + 0 + 0.015 


= 125.66 rad/s 


B.5.2 Program Inputs 


M@pk = 125.66 
J, = Jigs + JL = 0.001562 
B, = 0 
T, = 10 
t, = t, = 0.015 
ty = tg = 0 


Ips... = VeSma = © (no limit on power supply given) 


0.mb = 25°C 


B.5.3 Complete Example 


With the values in Section B.5.2 as inputs, it is possible to utilize the procedure 
from Section B.3. The pertinent calculations and comments about each program 
step are summarized in Table B.5.1. It is noted that the initial guess concerning 
a likely motor candidate (i.e., an Electrocraft E530) is proven to be incorrect. As 
a consequence, steps 3 and 4 must be repeated to find a motor that meets the 
specifications. 


B.6 UNITS AND CONVERSION FACTORS 


In the following list of quantities used in the motor selection procedure presented 
in Section B.2, the preferred unit (i.e., the unit to be used in the procedure) is 
given first. When a quantity is specified using another unit, the conversion to the 
preferred unit is accomplished by multiplying by the factor shown. Defining equa- 
tions are given, where appropriate. 


TABLE B.5.1 SUMMARY OF CALCULATIONS FOR EXAMPLE 


program ; 
Calculations Comments 


J, x Ww P| 66 99 7 
| er There is no ‘run period 
sic t, + fy since f,, iS zero. 
Therefore, T.,, = 0. 
_ 0,0015162_x_125.664 
0.015 
1 = 23.09 oz-in. 
—J, X w 
( ee = —————— + T, 
= —3.09 oz-in. 
T.ms = 16.47 oz-in. 
Torax = 240 > Teco: and also |T accel Using an Electrocraft 
2 E530/110 motor, 
inequality (B.2.1) is 
(Tcont) max = 29> Toms satisfied. Continue. 
Jy = 0.004 oz-in.-s* Jy is moment of inertia of 
the motor, 110 tach, and 
T, = 3 oz-1n. bearings. 
B = 9.55 x 10~* oz-in.-s/rad 
004 + 0.001562) x 125.66 
: Taccel = Coys CO) +3+10 + (9.55 x 10-4) x 125.66 
0.015 
= 59.72 oz-in. 
Tecer = 33.48 0Z-in. 
T.,; = 48.41 oz-in. 
Torax = 240 > Taccer and also Ties Inequality (B.2.1) is 
violated. Go to next 
4 (T cont) max = 29< E ms motor on list of 


motors—assume M1030 
and go back to step 3. 


Jy = 0007) oz-in.-s* 
B = 9.55 x 107° oz-in.-s/rad 
T; 


Tg = 3273 OFM: 


2.5 oz-in. 


Ttece) = 5-33 02-in. 


I 
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TABLE B.5.1 (continued) 

















Program 
step Calculations Comments 
Teeak = 348 > Tyco; and also |Tiecei If Tpeax iS not given, it is 
calculated as K; X 
4 (Tcont)max = 35 > Tons Isemag: Inequality 
(B.2.1) is satisfied. 
Continue. 
K; = 5.8 oz.in./A 
dcinng = 60 A 
32.73 
5 = a ee 5.64 A 
5,33 
I, = — = 0. 
3 = Se 0.92 A 
Topeak = 5.64 A 
Tppan = 5.64 < Tiemaz 360 A Magnet not demagnetized. 
6 Continue. 
Ipeak < © Power supply maximum 
7 current not specified. 
Continue. 


ee An rE na 
R, = 0.7 + 0.15 = 0.85 0 


Ww = 0.00393 
Ry, = 2.8°C/W 
K, = 4.3 V/1000 rpm 
6 = 155°C 
8 armmax 


1, = 23.45/5.8 = 4.04 A 
0.85 x 2.8 x (4.04) 


Oise = 70.85 x 2.8 x (4.04)? x 0.00393 
= 45,9°C 
Fics — 45.9 5 a 25 = 70,9°C 


a SR a a 


; Motor runs ‘‘coo!”’ in 
9 Bam = 10.9 < Ose = 155°C continuous operation. 


Continue. 


ee ee ne ee a cere en ee en a 
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TABLE B.5.1 (continued) 
en ge 
Program 
step Calculations Comments 
Sa A= gE apt li Ra gg ge te cine cnc 
R, = 0.85[{1 + 0.00393 x (70.9 — 25)] = 1.003 0 





N, = 9.5493 x 10-3 x 125.66 = 1.2 x 103 rpm 
10 V, = 1.003 x 5.64 + 4.3 x 1.2 = 10.8 V 
V, = 1.003 x 0.92 + 4.3 x 12 =61V 
Veoeax = 10.8 V 
u Veeax = 10.8 < Power supply voltage not 


specified. Continue. 





Conclusion: An Electrocraft M1030 motor with 110 tachometer will perform well 
with a power supply capable of supplying 6 A at 11 V. 


The table format is as follows: 


Quantity (symbol, if any) = preferred unit 
= secondary unit x factor needed to convert to pre- 
ferred unit 
(Defining equation, if any) 


1. Mass (m) = ounce-second?/inch = weight in ounces/386.09 
weight in pounds x 16/386.09 
2. Length = inch = feet x 12 = meter X 39.37 = centimeter x 0.3937 
3. Linear velocity (v) = inch/second = feet x 12/second 
= meter X 39.37/second 
= centimeter X 0.3937/second 


4. Angular velocity w(t) = radians/second = rpm X 0.10472 
1000 rpm x 104.72 


5. Force (F) = ounces = pound X 16 = newton X 3.5969 


6. Torque (7) = ounce-inch = pound-feet x 192 

= newton-meter X 141.612 
7. Moment of inertia (J) = ounce-inch-second* 
kilogram-meter* X 141.612 
kilogram-centimeter* x 0.014162 
gram-centimeter? X 1.41612 x 10™ 
8. Viscous damping (B) = ounce-inch-second/radian 
ounce-inch/1000 rpm Xx 9.5493 x 107° 
= newton-meter-second/radian x 141.612 
newton-meter/1000 rpm x 1.352 
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9. Temperature (6) = degrees Celsius 
aps degrees Fahrenheit — 32 
1.8 
ounce-inch/ampere 
1000 rpm/ampere x 1.3887 x 10° 
= newton-meter/ampere X 141.612 


11. Voltage (back EMF) constant (K,) = volts/1000 rpm 
volt-second/radian x 104.72 


10. Torque constant (K,) 


APPENDIX C 


Digital Control of a Single Axis 


C.0 INTRODUCTION 


es the implementation of a digital control for a single axis. 
ss the various concepts that must be considered 


trolled servo loop used in a robot. 


This appendix discuss 
From a top-down approach, we discu 
when implementing a computer con 


C.1 SYSTEM DESCRIPTION 


The block diagram of a single-axis servo is shown in Figure C.1.1. Essentially, it 


consists of two components: 


e Digital servo loop 


e Profile generator 

ts load, and a power amplifier 
ment some type of closed-loop 
me interval) and 
f the robot axis 


The digital servo loop contains the motor, ! 
and the electronics and software necessary to imple 
control. The profile generator computes set points (over some ti 
sends them to the digital servo loop so that the ultimate position o 
driven by the motor’s shaft follows some prescribed function of time. 

The remainder of our discussion will concern ultimate control we will have 
over the motor’s shaft position. Thus our control strategy assumes that the profile 
generator provides discrete position versus time set points, Q(nT). Overa given 
time interval, these set points define a specified function which the motor’s shaft 
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App. c 
Digital Servo Loop 
ge 7} 
Desired | | 
Profile | | 
Data Profile 6(nT) | | 6(nT) 
Generator Position 






Set Points 





Figure C.1.1. Profile generator and digital servo loop. 


position, 6(nT), should follow. If we wish the axis to remain fixed at Some position, 
the same set point must be sent at each update to the digital servo loop. It js 
extremely important to understand that set points must always be sent to the input 
of the digital servo loop even if no motion is to occur. 


C.2 THE PROFILE GENERATOR 


Figure C.2.1 shows a detailed description of the profile generator. It should be 
apparent that the implementation of this block requires an output stream of data 
in real time—that is, the output corresponds to a desired position as a function of 
time. This discrete data signal also carries implicit information about the desired 
velocity and acceleration states of the motor’s shaft. 


A possible scenario of the operation of the profile generator is as follows: 


1. The displacement and desired maximum tj 
profile generator. 

2. Based on the constraint data, information is se 
so that it can comply with the request. 

3. When a “start” signal is received, the a 
output spaced by the clock’s period. 

4. After all the set points have been 
generated. 


me for a motion are sent to the 


nt to the displacement algorithm 
Ppropriate number of set points are 


generated, a “profile completed” signal is 


As can be seen from Figure C.2.1, there 
displacement algorithm and the control logic. 
rule by which the set points are generated. Th 
reports status, and checks the validity of the d 
algorithm. 

The profile generator is usually implemented in software. 
sequence [8,(m7)] must be output in real time, 
for synchronization. Later we will see that this c 
the digital servo loop. 


are two major components: the 
The displacement algorithm is the 
€ control logic accepts commands, 
ata presented to the displacement 


Since the data 
it is necessary to provide a clock 
lock is also needed to synchronize 


System 
Constraint 
Data 





Validated Inputs 








Desired Profile Data 
e Displacement 
e Maximum time for move 















Profile Completed Set Points 





Logic Algorithm 


Other Status Information 


Real Time Clock 





Figure C.2.1. Details of the profile generator. 


Certain constraints defined by the physical system (i.e., motor, power sup- 
plies, and so on) are either resident in the algorithm or supplied as input data to 
the control logic. These constraints are used to prevent this block from producing 
profiles that are beyond the physical capabilities of the system. Thus if the time 
required for a motion would result in a value of acceleration that could demagnetize 
a motor or could stress a transmission, either an error signal could be sent or the 
system would report the exception but compensate and possibly use the maximum 
value that was permissible. This latter condition may actually produce a profile 
that does not comply with the initial request. 

The desired profile data constitute the minimum set of information needed 
to tell the displacement algorithm the information it needs to generate set points. 
For instance, if the total time for the move and the displacement are specified, 
then based on known relationships, the algorithm can determine the values of 
acceleration, constant velocity, and decelera.‘on that satisfy the request without 
violating the constraint data. | 

Figure C.2.2 shows the position and acceleration waveforms for a trapezoidal 
velocity profile. While this profile is common practice throughout industry and 
quite simple to analyze, it contains impulses in the jerk function (ize.., the third 
derivative of position) which can excite various modes of the system, which may 
result in undesirable operation. To reduce or eliminate this problem, higher order 
polynomials can be used whose characteristics are to constrain the magnitude of 
the jerk; however, we will use the trapezoidal velocity profile in our discussion 
due to its simplicity. . - 

It can be shown, using calculus, that the corresponding position waveform 
for the trapezoidal velocity profile can be described by the following set of equa- 
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Acceleration: a(t) 


max 


— Omax 


Velocity: w(t) 


Wmax 


Position: 6(t) 


Dsinal 


Ginitial 
Time ———> 


Jef tf 


Figure C.2.2. Trapezoidal velocity profile and corresponding acceleration and 
position profiles. 


tions. These equations are solely functions of the three time intervals, (t,, tev» ta) 
corresponding to the acceleration, the constant velocity, and the deceleration times 
respectively and the maximum velocity, max. 


IOsist 
O(t) = 2 [Omax/ta] 2 (C.2.1) 
tsts(t, + la) 
O(/) = 2 Qu &)] + Tt — & Ona (C.2.2) 
(to + th) Stes (tg + ley + ta) 
O(t) = Wmaxl3la + tov] + 


€.2.3 
Omaxl(t — (la + bev) — ( — (ta + te))/2tall a 
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By substituting nT for t (where n = 0,1,...& 
any discrete time. The maximum value, k, must be 
the total motion time (ft, + ty + ty) can be forced t 
Note that T is the sample period for the waveform 


) we obtain the position for 
an integer. By design choice, 
o be an integer multiple of T. 


velocity profile. Since it was stated previously that the stream of data was required 
to be in real time, this solution may not be practical for the com 
of the hardware chosen, Of Course, we could always get a mo 
puter, but this may not be cost effective. 


One possibility is to Precompute the information and store it in a lookup 
table. This table can then provide the data from memory at the correct times. 
At face value, this seems to be the solution, and in fact it is for certain cases 


putational power 
re powerful com- 


3 


b] 


such as the desired velocity and desired acceleration for a particular motion. This 
set of information is a better model for the concepts discussed in Chapter 2. 

An interesting alternative to either table lookup or exact equations is to do 
the integration digitally in real time. By starting with a description of the accel- 
eration profile, in terms of the magnitude of the maximum acceleration and the 
three time intervals needed to obtain the desired displacement, one could imple- 
ment the following set of equations, which are quite simple. 


w(nT) = w([n — 1]T) + T a(nT) (C.2.4) 
O(nT) = O([n — 1]T) + T w(nT) (C2) 


These equations are based on a simple forward rectangular integration scheme. 
Eq. (C.2.4) is.an exact solution, while Eq. (C.2.5) will have an error associated 
with it. Even though the possibility of an error exists, if the integration rate 
(defined by T’) is fast enough, it may be quite small or can be removed by modifying 
several positions of the profile by adding part of the error term. If the error in 
Eg. (C205) 1s unacceptable, a bilinear integration scheme can be used which yields 
the exact result for integration of a trapezoid. If higher order polynomials are 
used to describe the displacement curve, the error due to simple forward integration 
will be more pronounced and either the integration period will have to be reduced 
©r more accurate integration schemes chosen. - 
Further simplification is possible by eliminating the constant coefficient T. 
This can be accomplished by normalizing the output by T. Additionally, Omax May 
be scaled so that the output data stream is in the same granularity as defined by 
the encoding device. That is, properly scaling Fqs. (C.2.4) and (C.2.5) will give 
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a data stream whose units are encoder pulses per update and encoder pulses re- 
spectively. _ 

As mentioned previously, when the profile generator is implemented, it must 
recognize certain physical constraints about the actual system and produce data 
that are consistent with the ratings of the components. For example, if the motor 
and amplifier are sized for the worst-case conditions (using a scheme such as 
outlined in Appendix B), the profile generator must have knowledge of the limi- 
tations based on parameters it understands, such as absolute maximum allowable 
acceleration and absolute maximum allowable velocity. With this information and 
a desired displacement, an algorithm can find values such as fy, bey» bas and Wax 
which will generate a position data stream that can be tracked by the digital servo 
loop. 

In the actual implementation of a complete robotic system, the calculations 
required to generate the set points for all of the servos may take a considerable 
amount of time. For example, consider the requirements of the back solution as 
discussed in Chapter 8. If the updates to the digital servo loop are too slow, the 
performance may be unaceptable or instability may result. A method of alleviating 
the lack of data in the servo is to use an interpolator. Essentially, the interpolator 
takes the difference between two successive profile generator set points (which 
may occur every 16 servo updates), divides the difference by the number of digital 
servo loop updates, and feeds the set point data at the servo rate. This allows the 
profile generator sufficient time to do its computations yet provides the servo with 
set point data at the desired rate. 


C.3 THE DIGITAL SERVO LOOP 


The digital servo loop is depicted in Figure C.3.1. Although we are calling it 
digital, it does contain analog components. However, since the control algorithm 
is done by a digital process, we are justified in using the digital terminology. AS 
shown, the analog components consist of the dc motor and its associated load, a 
power amplifier, and a D/A converter. The controller and summing junction are 
implemented by difference equations within some computational element (e.g., a 
microprocessor). In practice, the feedback transducer could be an optical encoder 
(as discussed in Chapter 5) whose output pulses would cause an up/down counter 
to be updated whenever motion occurs. We have modeled the position feedback 
transducer by an integrator (which converts the motor’s shaft velocity to position) 
immediately followed by a uniform rate sampler to convert the continuous position 
signal into hs “—— me so that it can be applied directly to the summing 
unction. To implement uniform sampli 
7 acid only On tend ever T secenuls, pling, the register connected to the counter 
To summarize the operation of this block, at a given rate (every T seconds) 
a digital value is placed on the input of the D/A converter which pu the motor’s 


6, int) * 


Set Points 
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Encoder Model 


Summing 
Junction 


ent)! pigitl | SOO) pa Power 
Controller Converter Amplifier 





Figure C.3.1. The digital servo loop. 


shaft to move. The shaft’s position is monitored by an encoder which updates a 
counter. The value of the counter, 6(7), is read by the computer at the same 
rate the D/A updates and is compared with the set point @,(n7) generating an error 
signal, e(nT). The error signal is operated on by the difference equation of the 
digital controller to produce the control signal driving the D/A converter, c(nT). 

For purposes of our discussion, we let the digital controller be a PID algorithm 
(see Chapter 4). Figure C.3.2 illustrates the block diagram of the digital controller 
with difference equations performing the differentiation and integration operations. 

Figure C.3.3 shows the corresponding z domain representation of the con- 
troller. 

At this point, we will mention a very important concept: the actual imple- 
mentation of the integrator. Figures C.3.2 and C.3.3 both utilize a bilinear trans- 
formation for the integrator. It can be shown that this particular implementation 
preserves both regions of stability and instability when mapping from the s to the 
zplanes. Both of the other common forms of integration (i.e., forward rectangular 









(nT) = 
I({n-1]T) + 


+ [e(nT) + e([n-1]T)] 











d(nT) = 
e(nT) —e([n-1]T) 
T 






Figure C.3.2. Digital implementation of PID controller. 
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Figure C.3.3. z-transform model of PID controller. 


and backward rectangular) do not preserve both the stable and unstable regions 
simultaneously. Specifically, forward rectangular preserves stability but under 
certain conditions maps unstable regions into the unit circle, while backward rec- 
tangular preserves the unstable regions but may map a stable region outside the 
unit circle. These concepts become important if one chooses to model a system 
with a digital controller as a continuous system and are dependent on the sample 
rate chosen. If sampling is fast enough, even without the bilinear implementation, 
no problems should occur; however, in cases of undersampling, the results are 
instability and inaccuracy. Modeling of a system such as shown in Figure C.3.1 
in the continuous domain also requires the addition of a phase shift of T/2 radians 
due to the D/A converter. However, if one models the system in the z domain, 
regardless of the form of integrator chosen, and ensures stability by the unit circle 
criteria, no problem will exist by design. 

Another point to consider when choosing an integration scheme is the ac- 
curacy that the algorithm will provide. Although stability may be designed in, the 
actual value of the integrator may be far from the desired result. Of course, the 
accuracy is dependent on the sample period. It can be shown that bilinear inte- 
gration running at an update rate of T seconds provides about the same accuracy 
as a forward rectangular scheme running with a T/10 second update rate. 

Examination of Figure C.3.2 will show that under certain conditions, the 
output from the integrator may grow very large. If fixed point arithmetic is used 
to implement the PID control algorithm, it is entirely possible that the value of 
the integral term may exceed the length of the word chosen as memory for the 
integrator. Unless something is done, a wraparound may occur and an unpre- 
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dictable operation will result. One practical way to circumvent this situation is to 
place a saturation nonlinearity after the integrator. Effectively, this will let the 
integrator reach a defined magnitude, say the maximum word length chosen, after 
which its value stays fixed until an input causes it to be reduced (i.e., move in the 
opposite direction). 

When implementing a saturation after an integrator, it is important to actually 
hold the integrator at its maximum (or minimum) value once the limit has been 
reached. That is, the integrator must stop increasing for inputs that would make 
it grow, but should respond immediately to inputs that would make it decrease. 
It should be clear that this is very different from letting the integrator always run 
but forcing the output to a constant if the value of the integrator is greater than 
some limit. 

Saturation is extremely important when interfacing the control signal c(nT) 
to the D/A convertor. Since D/A convertors have a finite word length, typically 
12 to 16 bits, it is necessary to ensure that the magnitude of c(nT) does not exceed 
the capability of the D/A converter. This is accomplished easily by adding a 
saturation nonlinearity before the converter so that the signal applied is in the 
converter’s range. 

Saturation may also be introduced to prevent some conditions from occurring. 
For example, if a constant torque is applied to a joint driven by a motor that is 
attempting to maintain a constant set point, it may be desirable to limit the input 
to the D/A converter so as not to burn out the motor. For the case of a new 
equilibrium position (different from the set point), the contribution from the de- 
rivative term would be zero, the contribution from the proportional term would 
be a constant, but the contribution from the integral term would grow since the 
error term was constant. The saturation after the integral term may not be suf- 
ficient to prevent damage and the value of the saturation nonlinearity preceding 
the D/A input could be reduced to limit the magnitude of the signal applied to the 
D/A converter in order to ensure that the motor current is kept below some 
maximum magnitude. 

At this point it is interesting to note that whereas the implementation shown 
in Figure C.3.1 includes the controller and a pnysical system, one could conceivably 
replace the physical components (D/A, power amplifier, motor, and load) with a 
linear model to simulate the digital servo loop. In fact, the blocks starting with 
the D/A converter and ending with the ideal sampler can be modeled in the 
z-domain and ultimately replaced with a difference equation. Thus by running 
exactly the same algorithms for the summing junction and controller in the model 
and using the difference equation to replace the physical components, the system 
may be tuned by modifying the PID parameters to obtain a desired performance 
response. These tuned parameters could then be placed in the actual controller. 

Although the model and the physical system may not be exactly the same, simu- 
lation will provide a reasonable starting point for the controller parameters which 
can then be fine-tuned in the actual system. 
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C.4 AN IMPLEMENTATION 


To give a perspective on the interaction of the profile generator and the digital 
control loop, the following example may be helpful: A system consisting of both 
the profile generator and digital control loop will be implemented using a single 
microprocessor, which has a real-time interrupt occurring every T milliseconds. 
To simplify our example, all the parameters to describe the desired trapezoidal 
velocity profile will be stored in memory (maximum acceleration and the times £,, 
t.,, and tz) as well as the PID gains. Additionally, we will assume that initially, 
the motor is stationary (i.e., maintaining position) at some position 8,, until a 
certain signal, enable_profile_gen, is asserted. At this point, the profile generator 
will begin operation and generate set points. The control loop will use the set 
points and the actual position of the motor’s shaft (available from a register called 
encoder _counter_register) to generate a value for the control which it will ultimately 
put on the D/A converter. After the profile generator has completed its sequence, 
it will assert the profile_complete flag and clear the enable _profile_gen flag, and 
the set points will remain fixed at the value of the final position, 0,. Remember 
that 8, is the sum of the initial position, 6, and the change in displacement caused 
by running the profile generator. 

Table C.4.1 defines one possible algorithm. The variables used are consistent 
with the previous figures, equations, and discussions in this appendix. Note that 
in this implementation, the control algorithm executes first, using the value in the 
set point register. When motion is in progress, the profile generator computes 
the set point for the next update immediately following the current update. This 
approach guarantees that the data are placed on the D/A converter at a fixed rate, 
since the code executing from the beginning of the interrupt to the D/A output 
are straight line and deterministic in nature. 

Due to contributions from friction, or the actual system’s response (as defined 
by the PID parameters), it is possible that the motor’s shaft position is not at the 
final position defined by the profile generator after the profile_complete flag is 
asserted. Consider for instance, the case where the system is somewhat under- 
damped. Even though the profile generator is finished and the set point is constant, 
the system must respond as defined by its difference equation. Therefore, it may 
be necessary to test the value of the error signal, e(nT), and set another flag to 
indicate when some settling criteria has been attained. 


C.4.1 The Model Paradox 


A careful examination of the algorithm in Table C.4.1 and the block diagram of 
Figure C.3.1 will show a subtle difference. Specifically, Figure C.3.1, which is the 
typical topology shown in most textbooks, shows the system output @(n7) being 
combined with the set point information and the control algorithm to immediately 
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TABLE C.4.1 PSEUDOCODE IMPLEMENTATION FOR A PROFILE GENERAT 
DIGITAL CONTROL LOOP OR AND 


I 
ON INTERRUPT 

{ 

@ = encoder_counter_register; /* current position */ 

6s = setpoint_register; /* set point 0s */ 
/* summing junction */ 

e = Os — 0; 
/* PID controller */ 

i = Lold + (e + e_old)/2;  /* integrator */ 


Lold = i; 
d = e — e_old; /* derivative term */ 
e_old = e; 
c = (kp *e) + (ki *i) + (kd * d); 
/* put control signal c on D/A converter */ 
da = ¢; 


/* Profile generator */ 
if (enable_profile_gen = = TRUE && profile_complete = = TRUE){ 
n = 1; 
profile_complete = FALSE; 
a = max_acceleration; 


} 
while (profile_complete = = FALSE) 
if (n > ta) 
a = 0; 
else if (n > (ta+tcv)) 
a = —max_acceleration; 
else if (n > (ta + tcv + td)){ 
a = 0; 


profile_complete = TRUE; 
enable_profile_gen = FALSE; 
} 
wo = wold + a; /* compute new velocity */ 
set point_register = old_set point + w; 
old_set point = set point_register; 
wold = w; 
n=n+-+l; 
} 


} /* end of interrupt routine */ 


eee eticaciae ea a a gee a gee 


generate 0(nT). This is mathematically correct; however, this particular topology 
Cannot be implemented in the real world because of communication and response 
delays. Examination of the pseudocode will show that while the current value of 
the system output, 6, and the set point information, 6, are also combined to feed 
the control algorithm, the result of this control is not seen until the encoder is read 
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again at the next update. A little thought should convince the reader that in order 
to make Figure C.3.1 model the actual system under computer control requires 
the addition of a unit delay (z~!) in the feedback path along with the difference 
equation (D/A through sampler) used to model the physical components. This 
technique will make the block diagram in the z domain model the physical system 
and therefore allow analysis in terms of stability and transient performance. 
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Servo amplifiers, 289-307 
current amplifier, 302-4 
current and voltage feedback 
amplifier, 304-7 
effects of feedback in, 295-301 
linear servo amplifiers, 290-92 
PWM amplifiers, 292-95 
voltage amplifier, 301-2 
Servomotors, 4, 20, 205, 210-15 
Servomotor selection (See Motor 
_ selection procedure 
Set pont, = 203-4, 640, 658-61, 


Slider cranks, 133—34, 137 
Slip sensors, 407-15 


744 


413-15 
Belgrade hand, > 10 
forte oscillation. i S 
interrupter type ~ 42 
slip sensing ~ ers, Cameras) 

Solid-state cameras (See aa 

Specification guide, comme 

i robots, 696-710 
rings: 

*Pinetic energy. 119 
linear, 103 
torsional, 107-8 | ‘ak 
work done by spring, 

SRI industrial vision system. 

Stanford arm, 4-9, 927 
forward kinematl 

Stepper motors, 20,2 
advantages of, 249 
characteristics of, 249 
damping rotor oscillations, 
drives, 259- 
half-step mode, 253-54 
linear type, 261-71 
microstep mode, 254 
permanent-magnet type, 25) 
principles of operation, 251-52 
variable reluctance type. 25 1-55 

Strain gage force sensing, 419-25 

Structured light, 454-55, 491, 

489-5 


499-506 


c solution. 619-21 
7 


— 


254-55 


Symbolic T matrix, 617 
Synchro-to-digital converter, 327-329 
tracking SDC, 327-28 


Tactile sensors, 384-402 
conductive elastomer, 388-92 
hybrid, 397-99 
shoes 399-402 
photodetector. 386-88 
pneumatic switch, 392-94 
polymer, 394-97 
roximity rod, 384-86 
LSI-conductive elastomer, 399 
Tele-operator, 3 
Three-point alignment method, 603 
TIR (total indicated runout). 151 
Tool axes: 
a parallel to, 644 
simultaneous motion of too 
and, 644 em 
Tool mounting plate, 88 
Tool point, 595 
eatihe 595 
simultaneous motion 
heer of tool axes 
Tool transformations, 600 
Tooth ratio (TR), 122 
Tooth-to-tooth errors, 15] 
oe 106-7 
orsional pendulum, 115- 
Torsional resonance. ieee 
Touch sensors (See Tactile sensors: 
me See also Welding sensors) 
rene error, servo, 230-32 : 
uormaton Matrices, 589-93 
Ormula for the inverse of, 589 90 


objects : 
e909 oTmations, 


Pre- and post multiplication of 
— transformations. 592-93 
kinctnaties 
and, 561-66 
a architecture 657 
Tdimate reference fr: a 
581-89 ‘iii 


forward soluti 
on, — 
homogeneous can . 
556~—81 Nates | 


homogeneou 
SOUS transfi 
inven entpulator and "30. 
ETS€ solution, 62339 ~609 


Jacobian control, 649 ~ $7 
motion generation. 640-49 
transformation matrices, $4993 
what they may represent, ba 
Translation and linear motion, 102-6 


‘dal velocit profile, 261 ~62, 
Trapezore’ 449, 674-84. 713-15, 
731-33 


Twist, of a link. 612 


trasonic sensors, 375-77, 397-98 
United States, robot production, 49 
Units and conversion factors, 724-28 


VAL programming language, 32, 62, 
538-46 

Vectors. 566-570 

cross product, 570 

dot product, 570 

null ae oe a 

rofiles, 261-62, ~49, 

ve P7484. 713-15, 731-33 
Velocity sensors, 34, 205, 237-44, 


de tachometers, 34, 237-42, 361-63 
velocity measurement, digital, 205, 
42-44, 364-66 
encoder/frequency to- voltage 
converter, 364-65 
encoder and software, 238-42, 
365-66 © 
Vertex points, object, 590 
Vibrations, 153 
critical shaft speed, 154-56 
Vidicon (See Cameras) 
Vision systems, 440-506, 686-91 
binary, 488 
calibration of, 690-89 
camera selection, design example, 
9 


—8 
CCTV, 441-42, 689 
gray-level, 488-89 
imaging components, 443-53 
image capture time, 450-53 
line sensors, 444 
planar sensors, 445-48 
point sensors, 443 
volume sensors, 452-53 
reference frames and, 607n-9 
OpeRr on systems, examples of, 
6 


structured ight systems, 454-55, 
489-500 


types of, 487-506 
vision training, need for, 487 

” See also Computer vision 
LSI-conductive elastomer sensor, 


99 
Voltage amplifier, 301-2 
Welding sensors, 380-81, 402-7 


active seam tracking, 403-4, 406-7 
Passive seam tracking, 404-5 
wi nrough-the-arc, 380-81 
rist axes (See Minor linkages) 
rist, compliant (See Remote center 
compliance device) 


Work envelo 
Work cell. § ‘i a Workspace) 


Workspace, 171 
incremental, 186 
ork Volume (See Workspace) 
orid axes, motions saratiel to, 644 
tid reference, definition of, 5¥ 


Yaw, definition of, 24-25 


Zero r 
eference ch 
z-transform, channel, enceder, 356 


model of PID controller, 736 
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